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(54) GAIT PATTERN GENERATING DEVICE FOR LEGGED MOBILE ROBOT 



(57) A gait generation system of a legged mobile ro- 
bot, In particular a biped robot that has the dynamic 
model expressing the relationship between the motion 
of the body and leg and the floor reaction force, and pro- 
visionally determines the current time gait parameters 
Including at least parameters that determine leg trajec- 
tory and the like in response to a demand, supposes the 
parameters of a periodic gait, corrects the current time 
gait parameters such that the body trajectory deter- 
mined from the dynamic model and the parameters of 
the currenL time gait, etc., converges to a body trajectory 
determined from the parameters of the periodic gait, and 



determines instantaneous values of the currenttime gait 
based on the corrected currenttime gait parameter. With 
this, the system can generates a gait of any stride, turn- 
ing angle and walking period, Including the floor reaction 
force acting on the legged mobile robot, that satisfies 
the dynamic equilibrium condition. Further, the system 
can generates a gait in such a manner that the displace- 
ment and velocity of each robot part are continues at the 
boundary of the generated gait and that succeeding 
thereto, can generate a gait that is high in the margin of 
stability, can predict future behavior of the robot and 
generate a gait such that no disadvantages such as pos- 
ture divergence occurs. 
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Description 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES TO 

5 [0001] The present Invention relates to a gait generation system of a legged mobiie robot, and more particularly to 
a system for generating or determining a gait freely on a real-lime basis. 

BACKGROUND ART OF THE INVENTION 

10 [0002] The appiicant proposes, In Japanese Laid-open Patent Application No. Hei 10 (1998)-86081 , conducting gait 
generation freely by converting a set of standard gaits, designed with the use of an off-line computer, into a set of time- 
series data including parameters and a body trajectory to be stored In a memory of a microcomputer mounted on a 
robot, and by calculating a weighted average of instantaneous values of individual gaits whose parameter relating to 
time such as a walking period are the same. 

15 ' [0003] However, If a weighted average Is calculated between Individual gaits that are different In the time parameter 
such as the walking period, the generated gait does not satisfy the dynamic equilibrium condition even in an approxi- 
mated manner. Thus, the proposed' technique failed to generate a gait that is different from the standard gait in the 
waii<ing period, 

• [0004] It should be noted here that the "dynamic equilibrium condition" indicates a situation where a Ziyi P determined 
20 from the gravity and inertia! force of a desired gait is equal to a desired ZMP, to be more specifically, a situation where 
moment of the resultant force of the inertial force and gravity of the robot about the desired ZMP is zero. Here, the 
ZIVIP (Zero Moment Point) indicates a floor point at which the resultant force of the inertial force Induced by motion 
and the gravity intersect the floor More precisely, it indicates a point of action on the floor at which the moment of the 
resultant force of the inertial force induced by motion and gravity is zero except for its vertical coniponent. 
25 [0005] Further, In the proposed technique, since it is sometimes necessary to turn ai desired ZK/IP awdiy. large from 
its expected trajectory so as to bring both the body position and velocity continuous at boundary of a gait of a walking 
step and that succeeding thereto, the margin of stability may occaslonaliy lower ^ ■ " '^ • • ■ • 

[0006] Further, in orderto realize various l<lnds of walking, the proposed technique requires a large number of stand- 
ard gait time-series data to be stored and hence, needing an increased capacity of memory. Furthermore, a set of* 

30 standard gaits m ust be prepared on an off-line computer by trial and error. In addition, when It Is attempted to generate 
a gait that is quite different from the standard gait, the approximation is disadvantageously degraded markedly 
[0007] Aside from the above, since gait generation can not act against physical laws, gait parameters such as the 
ZMP should be determined within a permissible range of the physical laws. Moreover, assuming the dynamic system 
of a biped robot as a system that Inputs the ZMP and outputs the body position, It is a divergence system. It therefore 

35 becomes necessary to prevent a behavior of robot from diverging by generated gait pararneters. Here, "divergence" 
indicates, as shown in Figure 8 referred to later, a body position of the biped robot deviates far away from Its feet 
positions. • 

[0008]. : From this point of views, when generating gait on a real-time basis, it Is preferable to predict future behavior 
that would occur in the robot by the generated gait, and to avoid divergence if the possibility of divergence is predicted. 
40 [0009] However, as shown in Figure 23, when a robot (biped robot) is modeled to have multiple material points, since 
the volume of calculation and the non-linearity of system increase, it is difficult for an on-board computer (mounted on 
the robot of ordinary performance) to determine gait terminal state on a real-time basis. 

[0010] As regards the future behavior prediction and divergence prevention technique based thereon might be re- 
alized to a certain level, by, for example, storing various kinds of knowledge and by selecting a desired gait at every 
45 gait switching in response to the state and objective at that time from the stored knowledge. In practice, however, a 
trial to cope with all possible condition would cause an explosion of combination, and this method would actually be 
impossible. 

[001 1] Therefore, It is desired in the field of legged mobile robot technology to simplify a dynamic model that describes 
the robot dynamics In such a way that robot's future behavior can analytically be predicated In calculation on a real- 
50 time basis. 

[0012] As typical robot dynamic models, following two models are known. 

1 ) a model assigned with a single material point. 

2) a model assigned with multiple material points (but, material points with less Influence are neglected). 

55 

[0013] The single-materlal-point model of 1 ) Is proposed In Japanese Patent Publication Hel 4 (1 992)-15068. In the 

proposed technique, the robot is model as a single-material-point modef in which the material point is only set at its 
body to ensure linearity such that it is controlled the body height to be constant. This model makes it easy to determine 
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robot behavior analytically. 

[001 4] Since the biped robot in the proposed technique is quite small in weight the leg reaction force can be neglected 
without leaving significant Influence to exist. However, in case ot a biped robot of humanold type, since the mass of 
its leg is so large that it can not be neglected, if the proposed technique is adopted to the humanold type robot, the 
accuracy of approximation will accordingly be degraded and the robot may, at worse, turn over if controlled to wa!i< at 
a high speed. 

[001 5] As an example of the model of 2), it can be cited a model described in a paper "Biped Walking Control Method 
Adapting to an Unknown Uneven Surface" (Journal of the Robotics Society of Japan; Vol. 13 No. 7; October, 1995). 
[0016] In the proposed technique, the material points are set on knees and ankles of each leg and on the body. More 
specifically, the individual materia! points are set on fixed points (coordinate) in coordinate systems set locally on its 
links and joints. When comparing this model with that shown in Figure 23 (in which the material points and inertia are 
set at every link), the model of 2) can decrease the volume of calculation to 1/1 0 or thereabout. In addition, the accuracy 
of approximation of the model of 2) will be improved than the model of 1) and even a robot having a large-mass leg 
can walk in accordance with gaits generated by the technique mentioned In the paper. 

[0017] However, since the non-linearity in the model of 2) is still excessive, like the model shown in Figure 23, it is 
not possible to use the model of 2) for predicting future behavior analytically so as to avoid divergence. 

DISCLOSURE OF THE INVENTION 

[0018] A first object of the present invention Is to eliminate the drawbacks of the technique proposed In Japanese 
Laid-open Patent Application No. Hei 1 0(1 998)-86081 proposed by the applicant and the prior art model simplification 
techniques mentioned above, and to provide a gait generation system of legged mobile robot which can generate a 
gait (Including floor reaction force that satisfies dynamic equilibrium condftion) of the legged mobile robot freely and 
on a real-time basis in such a way that a robot walking at any stride, turning angle and walking period, etc. , are realized. 
[0019] A second object of the present invention is to eliminate the drawbacks of the technique proposed earlier and 
the prior art model simplification techniques mentioned above, and to provide a gait generation system of legged mobile 
robot which can generate a gait of the legged mobile robot freely and on a real-time basis in such a way that position 
and velocity of every robot part Is continuous at boundary between the generated gaits with high margin of stability. 
[0020] A third object of the present invention is to provide a gait generation system of legged mobile robot which can 
predict future behavior of the legged mobile robot and prevent disadvantages such as divergence from occurring. 
[0021] A fourth object of the present invention is to provide a gait generation system of legged mobile robot which 
can ensure real-time gait generation with high speed calculation. 

[0022] In order to achieve the objects, the present invention provides, as defined in claim 1 , a system for generating 

a gait of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising: 
a dynamic model that expresses relationship belween motion of the leg and the body, and a floor reaction force; current 
time gait parameter provisionally-determining means for provisionally determining parameters of a current time gait 
including at least parameters detemainihg a trajectory of the leg and a trajectory of the floor reaction force, in response 
to at least a demand; periodic gait parameter supposing means for supposing the parameters of a periodic gait suc- 
ceeding to the current time gait in response to at least the demand; current time gait parameter correcting means for 
correcting at least the provisionally determined parameters of the current time gait such that the trajectory of the body 
determined based on the dynamic model and the parameters of the current time gait and the periodic gait succeeding 
thereto substantially converges or becomes equal to a trajectory of the body of the periodic gait determined from the 
parameters of the periodic gait; and current time gait instantaneous value determining means for determining instan- 
taneous values of the current time gait based on at least the corrected parameters of the current time gait. 
[0023] Since it is configured to have a dynamic model that expresses relationship between motion oflhe leg and the 
body and a floor reaction force, provisionally determines parameters of a current time gait Including at least parameters 
determining a trajectory of the leg and a trajectory of the floor reaction force, in response to at least a demand, supposes 
the parameters of a periodic gait succeeding to the current time gait, corrects at least the provisionally determined 
parameters of the current time gait such that the trajectory of the body determined based on the dynamic model and 
the parameters of the current time gait and the periodic gait succeeding thereto substantially converges or becomes 
equal to a trajectory of the body of the periodic gait determined from the parameters of the periodic gait, and detemnlnes 
instantaneous values of the current time gait based on at least the corrected parameters of the current time gait, the 
system can generate, freely and on a real-time basis, a gait of any stride, turning angle and walking period, including 
the floor reaction force acting on the legged mobile robot, that satisfy the dynamic equilibrium condition. 
[0024] Further, the system can generates a gait in such a manner that the displacement and velocity of each robot 
part are continues at the boundary of the generated gait and that succeeding thereto, can generate a gait that is high 
in the margin of stability, can predict future behavior of the robot to generate a gait such that no disadvantages such 
as posture divergence occurs. Furthermore, the system can ensure real-time gait generation with high speed calcula- 
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tion. The dynamic model may be a sln^le-material-point model such as that disclosed In Japanese Patent Publication 
No. Her4(1992)-16068. 

[0025] As defined claim 2, there Is provided a system for generating a gait of a legged mobile robot having at least 
a body land a plurality of legs each connected to the body, comprising; a dynamic model that expresses relationship 

5 between motion of the leg and the body, and a floor reaction force; current time gait parameter provisionally-determining 
means for provisionally determining parameters of a current lime gait including at least parameters determining a 
trajectory of the leg and a trajectory of the floor reaction force, in response lo at least a demand; periodic gait parameter 
supposing means for supposing the parameters of a periodic gait succeeding to the current time gait in response to 
at least the demand; periodic gait boundary divergent component determining means for determining a periodic gait 

10 boundary divergent component that Is a value Indicating a divergent component at gait boundary when behavior of the 
body of the periodic gait is approximated by the dynamic model, based on the parameters of the periodic gait; current 
time gait parameter correcting means for correcting the parameters of the current gait such that the divergent compo- 
nent becomes equal to or becomes substantially equal to each other at terminal of the current gait generated with use 
of the dynamic model; and current time gait instantaneous value determining means for determining instantaneous 

15 values of the current time gait based on at least the corrected parameters of the current time gait. With this, the system 
can achieve the same advantages and effects as those mentioned with reference to claim 1 . 

[0026] As defined in claim 3. it is configured that a transitional gait is inserted between the current time gait and the 
periodic gait succeeding thereto. With this, in addition to the advantages and effects mentioned with reference to claim 
1 , since a constraint condition (boundary condition) In determining or setting the periodic gait becomes loose and it 

20 becomes possible to detennlne the to be closer to that desired, the margin of stability of the gait is made higher. 

[0027] As defined in claim 4. it is configured that the transitional gait includes a standstill gait. With this, In addition 
to the advantages and effects mentioned with reference to claim 1 , the determination of the divergent component at 
the boundary Of the periodic gait is made easier and the margin of stability of at sudden stop is made highen^ 
[0028] As defined in claim 6, there is provided a system for generating a gait of a leggied mobile robot having at least 

25 a body and a piurallty of legs each connected to the body, comprising: leg reaction force calculating means for calcu- 
lating a leg reaction force that is a resultant force of Inertial force and gravity induced by a motion of the leg^ without 
depending on behavior of the body; inverted pendulum model supporting point position calculating means for calculating 
a position of a supporting point of an inverted pendulum that describes dynarnic behavior of the from at least the 
calculated leg reaction force arid desired floor reaction fpjrje;^^^^^ 

so calculating displacement bf the Inverted penduluhn barfed oh at least the cab^ 

the inverted pendulum; body position calculating means for calculating a position of the body based on at least the 
calculated displacement of the inverted pendulum; and gait generating means for generating a gait based on at least 
the calculated position of the body. 

[0029]' Since it is configured to calculate a leg reaction force that is a resultant force of inertial force and gravity 

35 induced by a motion of the leg, without depending on behavior of the body, calculate a position of a supporting point 
of an inverted pendulum that describes dynamic behavior of the body, from the calculated leg reaction force and a 
desired floor reaction force, calculate displacement of the inverted pendulum based on the calculated position of the 
supporting point of the inverted pendulum, calculate a position of the body based on the calculated displacement of 
the inverted pendulum, generate a gait based on the calculated position of the body, the system can simplify the 

^0 dynamic model that models the legged mobile robot and can enhance the linearity of the model. 

[0030] Specifically, assuming the legged mobile robot as a biped robot, since the dynamic behavior is described by 
the inverted pendulum and all the forces are converted into a value indicative of the floor reaction force (more specif- 
ically, the ZMP), it becomes possible to achieve linear-combination of behavior of the robot body, and hence It becomes 
possible to conduct predictive calculation as to whether behavior of the model diverges on a real-time basis, thereby 

45 enabling to generating a gait that is more stable in dynamics. 

[0031] As defined in claim 6, there is provided a system for generating a gait of a legged mobile robot having at least 
a body and a plurality of legs each connected to the body, comprising: leg ZMP calculating means for calculating a leg 
ZMP that is corresponding to a ZMP of the leg that is a pseudo value of a resultant force of inertial force and gravity 
induced by a motion of the leg, without depending on behavior of the body; inverted pendulum model supporting point 

50 position calculating means for calculating a position of a supporting point of an inverted pendulum that describes dy- 
namic behavior of the body, from at least the calculated ZMP and a desired ZMP; Inverted pendulum displacement 
' calculating means for calculating displacement of the inverted pendulum based on at least the calculated position of 
the supporting point of the inverted pendulum; body position calculating means for calculating a position of the body 
based on at least the calculated displacement of the inverted pendulum; and gait generating means for generating a 

55 gait based on at least the calculated position of the body With this, the system can achieve the same advantages and 
effects as those mentioned with reference to claim 5. 

[0032] As defined In claim 7, it is configured that the inverting pendulum model supporting point calculating means 
calculates the supporting point of the inverted pendulum by subtracting a product obtained by muitiplying the leg ZMP 
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by asecondcoefficientfrom a product obtained by multiplyingthe desired ZMP by afi^^^ coefficient. With this, it becomes 
possible to achieve linear-combination of behavior of the robot body more completely, and hence it becomes possible 
to conduct predictive calculation as to whether behavior of the model diverges on a real-time basis, thereby enabling 
to generating a gait that is more stable in dynamics. Further, since It becomes possible to generate a motion (other 
than the gait) on a real-time basis, it becomes possible to combine the motion and the gait smooth. 
[0033] As defined in claim 8, there is provided a system for generating a gait of a legged mobile robot having aL least 
a body and a plurality of legs each connected to the body, comprising: a dynamic model having; a leg reaclion force 
calcuiating means for calculating a leg reaction force that is a resultant force of inertia! force and gravity induced by a 
motion of the leg, without depending on behavior of the body; inverted pendulum model supporting point position 
calculating means for calculating a position of a supporting point of an inverted pendulum that describes dynamic 
behavior of the body, from at least the calculated leg reaction force and a desired floor reaction force; inverted pendulum 
displacement calculating means for calculating displacement of the Inverted pendulum based on at least the calculated 
position of the supporting point of the inverted pendulum; and body position calculating means for calculating a position 
of the body based on at least the calculated displacement of the inverted pendulum; current time gait parameter pro- 
visionally-determining means for provisionally determining parameters of a current time gait Including at least param- 
eters determining a trajectory of the leg and a trajectory of the floor reaction force, in response to at least a demand; 
periodic gait parameter supposing means for supposing the parameters of a periodic gait succeeding to the current 
time gait in response to at least the demand; periodic gait boundary divergent component determining means for 
determining a periodic gait boundary divergent component that is a value Indicating a divergent component at gait 
boundary when behavior of the body of the periodic gait is approximated by the dynamic model, based on the param- 
eters of the periodic gait; current time gait parameter correcting means for correcting the parameters of the current 
gait such that the divergent component becomes equal to or becomes substantially equal to each other at terminal of 
the current gait generated with use of the dynamic model: and current time gait instantaneous value determining means 
for determining instantaneous values of the current time gait based on at least the corrected parameters of the current 
time gait. With this, the system can achieve the same advantages and effects as those mentioned with reference to 
claims 1 and 5. 

[0034] As defined in claim 9, it is configured that the floor reaction force includes at least a ZMP. With this, In addition 
to the advantages and effects mentioned with reference to claims 1 and 5, it becomes easy to describe the floor reaction 
force, thereby enabling to have the advantages and effects more firmly 

[0035] As defined in claim 1 0, it Is configured that the inverted pendulum Is a linear model. With this, the system can 
achieve the same advantages and effects as those mentioned with reference to claims 1 and 5, in particular In claim 5. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0036] 

Figure 1 is a schematic view showing an overall configuration of a gait generation system of a legged mobile robot 
according to an embodiment of the present invention; 

Figure 2 is an explanatory side view showing the structure of the foot of a legged mobile robot illustrated in Figure 1 ; 
Figure 3 is a block diagram showing details of a control unit mounted on the robot illustrated in Figure 1 ; 
Figure 4 is a block diagram showing the configuration of the gait generation system of a legged mobile robot 
illustrated in Figure 1 in afunctional manner; 

Figure 5 is an explanatory view showing a dynamic model that approximates the legged mobile robot illustrated 
in Figure 1 by an inverted pendulum to be used by a gait generator illustrated in the configuration shown by Figure 4; 
Figure 6 is a block diagram showing dynamic calculation conducted by the gait generator with the use of the 
dynamic model illustrated in Figure 5; 

Figure 7 is a set of time charts showing a trajectory of a point of action P of the resultant force of the inertial force 
and gravity of the leg'.s material point, to be used in calculating a pseudo ZMP value ZMPpend indicative of the 
supporting point of the inverted pendulum of the dynamic model illustrated in Figure 5; 

Figure 8 is an explanatory view showing a situation where a trajectory of the body of the robot illustrated in Figure 
1 diverges; 

Figure 9 is a set of time charts showing the pseudo ZMP value ZMPpend, in discretlzed fonn, Indicative of the 
supporting point of the inverted pendulum of the dynamic model Illustrated In Figure 5; 

Figure 1 0 is a time chart similarly showing a trajectory of the pseudo ZIVIP value ZlVlPpend, in wavefonn, Indicative 
of the supporting point of the inverted pendulum of the dynamic model illustrated in Figure 5; 
Figure 11 is a set of time charts showing resolved parts of the waveform of the pseudo ZMP value ZMPpend 
illustrated in Figure 10; 

Figure 12 Is a flow chart showing the operation of the gait generation system of a legged mobile robot illustrated 



EP 1 361 027 A1 



In Figure 1; 

Figure 13 is an explanatory view explaining steady turning gait to be used in the processing of the flow chart of 
Figure 12, from a landing position and the lii<e; 

Figure 1 4 is an explanatory view explaining a body trajecton/ of the steady turning gait to be used In the processing 
5 of the flow chart of Figure 12, fronn the landing position and the like; 

Figure 15 Is a subroutine flow chart showing the calculation of an initial divergent component of the steady turning 
gait referred to In the flow chart of Figure 12; 

Figure 16 Is a set of time charts explaining correction of a desired ZMP of current time gait parameters conducted 
in the processing of the flow chart of Figure 1 2 based on the initial divergent component calculated by the processing 
10 shown in Figure 15; 

Figure 17 is a subroutine flow chart showing the correction of the desired ZMP of the current time gait parameter 

conducted in the processing of the flow chart of Figure 12 based on the Initial divergent component; 

FigurelB is a subroutine flow chart showing the calculation of Instantaneous values of the current tinie gait refen^ed 

to in the flow chart of Figure 12; : • 
15 Figure 1 9 Is a time chart showing the body trajectory generated by the gait generation system of a legged mobile 

robot according to the first embodiment of the present Invention; 

Figure 20 is a subroutine flow chart, similar to Figure 15. but showing the calculation of the Inltlai divergent com- 
ponent of the steady turning gait, that is the operation of a gait generation system of a legged mobile robot according 
to a second embodiment of the present invention; 
20 Figure 21 is a subroutine flow chart, similar to Figure 17, but showing the correction of the desired ZlViP of the 

current time gait parameter in the operation of the gait generation system of a legged mobile robot according to 
the second embodiment; 

Figure 22 is a view, similar to Figure 13, but showing examples of the steady turning gait used in a gait generation 
system of a (egged mobile robot according to a third embodiment of the present invention; and 
25 Figure 23 Is an explanatory view showing a biped robot of a legged mobile robot modeled with all !lnl<s feet with 

material points. 

DETAil-ED DESCRIPTION OF THE PREFERRED EMB(yOM^^S^^^^^^- 

30 [0037] The gait generatloh system of alegged mbbiie robot according to the present invention will b^ explained with 

reference to the accompanied drawings. A biped robot Is taken as an example of the legged mobile robot. 

[0038] Figure 1 is a schematic view showing an overall configuration of the gait generation system according to the 

present Invention. 

[0039] As lllustratad In the figure, a biped robot (hereinafter simply referred to "robot") 1 has a pair of right and left 
35 legs (leg links) 2 each composed of six joints. The six joints include, arranged successively downward, a pair of hip^ 
joints 10R, 10L (the right-hand joint is indicated by R and the left-hand joint by L) for rotating legs with respect to hips, 
a pair of hip joints 12R, 12L in the roiling axis (about an X-axis), a pair of hip joints 14R» 14L in the pitching axis (about 
a Y-axis), a pair of knee joints 16R, 16L In the pitching axis, a pair of ankle joints 18R, 18L ln thfe pitching axis, and a 
pair of joints 20R 20L in the rolling axis. 
40 [0040] The robot is provided with feet 22R, 22L underneath of the joints 18R(L) and 20R(L), and a body (trunk) 24 
at Its top which houses a control unit 26 comprising microcomputers (explained later). In the above, the joints 10R(L), 
12R(L), 14R(L) make up the hip joints, and the joints 18R(L), 20R(L) make up the ankle joints. The hip joints and knee 
joints are conn acted to each other by thigh links 28R, 28L, and the knee joints and ankle joints are connected to each 
other by crus or shank links 30R, SOL. 
45 [0041] Further, two arms are connected at upper parts of the body 24 and a head is provided at the top of the body 
24. However, since the upper configuration does not have direct relationship with the gist of the present Invention, the 
Illustration Is omitted. 

[0042] With the above structure, each of the legs 2 is given six degrees of freedorh. When the 6*2=12 joints are 
driven to suitable angles during walking, a desired motion is imparted to the entire leg structure to cause the robot to 
50 walk arbitrarily in a walking environment of three-dimensional (absolute) space. (In the specification, " " represents 
multiplication In scalar calculation and outer product in vector calculation.). 

[0043] It should be noted that a position and a velocity of the body 24 Indicate a position and its displacement velocity 
of a predetermined position of the body 24, specifically a representative point of the body 24. 

[0044] As shown in Figure 1 , a known force sensor (more precisely, known as the six-axis force and torque sensor) 
55 34 Is disposed at a position below each ankle joint for generating a signal indicative of three directional components 
Px^ Fy, Fz of force and three directional components Mx, My, Mz of torque or moment thereby of the force and outputs 
a signal indicative of foot landing and the floor reaction force (the load acting from the floor). Moreover, the body 24 
has an inclination sensor 36 which generates a signal indicative of inclination with respect to a Z-axIs (the vertical 
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direction (the direction of gravity)) and its angular velocity. The electric motors of the respective joints are coupled with 
respective rotary encoders which generate signals indicative of angular displacements of the electric motors, 
[0045] As illustrated in Figure 2, a spring mechanism 38 is installed at a position upward from the foot 22 R(L), which 
constitutes a compliance mechanism 42 together with a sole elastic member 40 attached to the sole of the foot 22R 

s (L). The spring mechanism 38 has a box-like guide member (not shown) connected to the foot 22R(L), and a piston 
member (noL shown) connected to the side of the ankle Joint 1 8R(L), 20R(L) and the force sensor 34 and inserted In 
the guide member with an elastic member such that it moves in the guide member to a slight extent. 
[0046] In the figure, the foot 22R(L) illustrated in thick lines shows a condition where no floor reaction force is imparted. 
When subjected to the floor reaction force, the spring mechanism 32 and the sole elastic member 34, which constitute 

io the compliance mechanism 42, deform such that the foot 22R(L) shifts to the position and posture illustrated in dashed 
lines. This configuration is significant not only for decreasing the foot-landing impact, but also for enhancing the control 
performance, Since this configuration is disclosed in an application (Japanese Laid-Open Patent Application No. Hei 
' 5 (1993) - 305584) proposed by the applicant, no further explanation will be made. 
[0047] Although not shown In Figure 1 , a joystick 44 is provided at an appropriate location of the biped robot 1 , which 

15 enables an operator from the outside to Input a demand on gait, such as changing from straight advance to turning. 
[0048] Figure s is a block diagram which shows the details of the control unit 26 comprised microcomputers. Outputs 
from the inclination sensor 36, etc., are converted into digital signals by an A/D converter 50 and are then transmitted 
through a bus 52 to a RAM 54. Output signals from the rotary encoders that are disposed adjacent to the respective 
electric motors are transmitted through a counter 56 to the RAM 54. 

20 [0049] The control unit 26 includes a first arithmetic unit 60 and a second arithmetic unit 62 respective of which 
comprises a CPU. As will be explained later, the first arithmetic unit 60 conducts the gait generation, calculates joint 
angle displacement commands, and outputs the same to the RAM 54. The second arithmetic unit 62 readg the com- 
mands and the detected values from the RAM 54, and calculates values (manipulated variables), and outputs the same 
through a D/A converter 66 and servo-amplifiers to the electric motors which drive the respective joints. 

25 [0050] Figure 4 is a block diagram showing overall configuration and operation of the gait generation system of 
legged mobile robot according to the embodiment. 

[0051] Explaining this, the system includes a gait generator 1 00 which generates a desired gait freely and on a real- 
time basis and outputs them as will be explained later. The desired gait comprises a desired body position and posture 
(trajectory), a desired foot position and posture (trajectory), a desired total floor reaction force central point (desired 

30 ZMP) (trajectory) and a desired total floor reaction force (trajectory or pattern). 

[0052] The floor reaction force acting on each foot 22R(L) Is called a "foot floor reaction force", whilst the resultant 
force of the foot floor reaction forces acting on both feet is called a "total floor reaction force". Since the foot floor 
reaction force will rarely been referred to In the following, the "floor reaction force" will be used as the "total floor reaction 
force" if It is not specifically described. 

35 [0053] Explaining first the gait to be generated by the system, the present invention aims to provide a system which 
generates a gait on a real-time basis as mentioned above. More specifically, the present invention aims t6 generate a 
desired gait freely which Is necessary for conducting the robot posture stability control utilizing the composite compli- 
ance control proposed earlier by the applicant in Japanese Laid-Open Patent Application No. Hei 10 (1998) -277969, 
[0054] In the posture stability control proposed earlier, an error between a desired position and the detected position 

40 of the floor reaction force (ZMP) is determined, and either or both of the legs are moved to decrease the error, thereby 
ensuring posture stability, When the robot is about to turn over, the desired floor reaction force is intentionally shifted 
so as to shift the actual floor reaction force, thereby restoring the robot posture stability. 

[0055] In a legged mobile robot, thus, it is impossible to ensure stable walking or locomotion unless the relationship 
between the desired motion trajectory and the desired floor reaction force pattern satisfies the dynamic equilibrium 

^5 condition. To satisfy the dynamic equilibrium condition means, to be more specific, that the central point of the desired 
floor reaction force (the point of action on the floor at which the secondary moment of the desired floor reaction force 
distribution becomes zero) Is equal to the ZMP. If they do not accord with each other, when the compliance control is 
operative, the robot loses balance between the resultant force of the inertlal force and gravity and the floor reaction 
force and will, at worse, turn over. 

50 [0056] In the technique proposed earlier, this is deliberately utilized to restore stability when the robot Is about to 
turn over. As Is understood from the above, the legged mobile robot should have, as desired values In the control of 
locomotion, not only the desired motion pattern, but also the desired floor reaction force pattern that satisfies the 
dynamic equilibrium condition against the desired motion pattern. 

[0057] The desired floor reaction force is generally described by a point of action and by a force and moment acting 
55 thereat. Since the point of action can be set at any point desired floor reaction force has numerous descriptions. 
However, if the desired floor reaction force is described by selecting the aforesaid desired floor reaction force central 

point as a point of action, the moment of force is zero except for its vertical component. 

[0058] As stated above, in a gait that satisfies the dynamic equilibrium condition, since the ZMP calculated from the 
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desired motion trajectory and the desired floor reaction force central point are equa! to eacli otiier, the desired ZMP 
trajectory can be used In lieu of the desired fioor reaction force central point trajectory. 

[0059] Therefore, the above can be rewritten as; "the legged mobile robot should have, as desired values In the 
control of loconnotion, not only the desired motion pattern or trajectory, but also the desired ZMP trajectory (desired 
5 floor reaction force pattern)", . • 

[0060] Based on the above, the desired gait is defined in this specification as follows: 

a) The desired gait is, in a broad sense, a set of the desired motion trajectories and the desired floor reaction force 
pattern over a period of a walking step or steps. 
10 b) The desired gait is, in a narrow sense, a set of the desired motion trajectories and the ZI\/IP trajectory for a period 

of a single walking step. 

c) A series of walking is comprised of a series of gaits. 

[0061] Hereinafter, for a more rapid understanding, the desired gait is used to represent that gait defined in the narrow 
15 sense, unless It is mentioned to the contrary. Specifically, the desired gait is used to mean a gait for a period beginning 
from the initial state of a two-leg supporting period to the terminal state of a one-leg supporting period succeeding 
thereto. Here, needless to say the two-leg supporting period means a period during which the robot 1 supports Its 
weight with two legs 2, whereas the one-leg supporting period means a period during which the robot supports Its 
weight with one of the two legs 2. The leg (leg link) 2 which does not support the robot weight during the one-leg 
20 supporting period Is called the free leg. Since the definitions are described in detail In the proposed application (Hel 
1 0(1 998)-86081), no further explanation will be made. 

[0062] The object of the present Invention Is to generate the desired gait defined above freely and on a real-time 
basis. If such a gait can be generated freely and on a real-time basis, it becomes possible, for example, for ah operator 
to manipulate the robot 1 by remote control. IVIoreover, in manipulating the robot automatically it becomes possible 
25 not only to control the robot to walk in accordance with a predetermined sequence, but also to guide the robot to walk 
along . a.path or to effect high precision positioning. 

[0063] Here, conditions which the desired gait must satisfy will be explained. 

[0064] The conditions which the desired gait must satisfy will generally be classified Into the following five: 

30 Condition 1) The desired gait must satisfy, the dynamic equilibrium condition. In other words, the ZMP trajectory 

calculated dynamically from the desired motion trajectories of the robot 1 should accord with the desired ZMP 
trajectory. 

Condition 2) When a demand(s) on stride or In the angle of turning, etc., is made by a locomotion planner or path 
planner (neither shown) of the robot 1 or by an operator, the desired gait must satisfy the demand(s). 
35 Condition 3) The desired gait must satisfy constraint condition in kinematics such as that the robot fool must not 

dig or scrape the floor on which it walks, the joint angle must be within a movable range, and the joint angular 
velocity must not exceed a perriiissible range. 

Condition 4) The desired gait must also satisfy conditions of constraint in dynamics such as the ZIVIP haying to 
remain within the foot sole floor-contact area during the one-leg supporting period, and that the joint torque must 
^0 not exceed a possible maximum power of the joint actuators. 

Condition 5) The desired gait must satisfy boundary condition. As a matter of course, condition 1) results in the 
boundary condition that the position and velocity of robot's each part such as the body must be continuous in the 
gait boundary, (if not, infinite force would occur or the ZMP would move far away from the foot sole floor-contact 
area). 

45 

[0065] More specifically, the Initial state of n-i-i -th gait should correspond to the terminal state of n-th gait, especially 
In the body position, posture and velocity relative to the foot position. If the initial state of n-i-1-th gait Is already deter- 
mined, It suffices if the terminal state of n-th gait is accorded with the n+1 -th gait initial state. If not detennined, It suffices 
if the terminal state of n-th gait is within a range that ensures continuous walking without losing posture stability. Hcw- 
50- ever, as will be discussed later, it Is quite difficult to determine the terminal state range which ensures continuous 
walking without losing posture stability. 

[0066] Generally speaking, the desired gait is generated by a gait generation algorithm including parameter values 
or time-series table data. (In other words, to determine a gait means to determine the parameter values or time-series 
table data appropriately.) 

55 [0067] Various kinks of gaits can be generated by changing the parameter values or time-series table data. However, 
If the parameters or time-series table data are detemnined without paying careful attention, it is uncertain whether the 
generated gait can satisfy all of the conditions mentioned above. 

[0068] In particular, when generating the body trajectory satisfying condition 1) based on the ZMP trajectory by a 
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gait generation algorlthnn, even if the ranges, suitable for continuous walking, of the body position and velocity at the 
gait ternninal are known, it is difficult to deternnine the parameters relating to the ZMP trajectory such that both the body 
position and velocity will fall within the range at the gait end. 
[0069] The reasons of the difficulty are as follows: 

5 [0070] Reason 1 ) The robot body tends, once begins to move away from the ZMP, to move farther away therefrom. 
This will be explained using an inverted pendulum model which approximates the behavior of the robot body 
[0071] If the Inverted pendulum's supporting point deviates from a floor point (projected From its center of gravity, the 
deviation diverges and the pendulum turns over. Even at the time of turnover, the resultant force of the ineitial force 
and gravity of the inverted pendulum is acting on the supporting point (in other words, the ZIVIP is kept equal to the 

10 supporting point), and the resultant force is kept balanced with the floor reaction force acting through the supporting 
point. The dynamic equilibrium condition can merely describe the relationship, at Instance, between the Inertial force 
and gravity and the floor reaction force of a moving object. 

[0072] It is a frequent misconception that continuous robot walking is ensured If the dynamic equilibrium condition 
Is satisfied. However, satisfaction of the dynamic equilibrium condition does not mean the robot is at a stable posture. 
15 Likes the center of gravity of the inverted pendulum tends, if begins to move away, to move further away, the center 
of gravity of the robot tends, once begins to move away from the position immediately above the ZMP, to move farther 
away therefrom. 

[0073] Reason 2) The one-leg supporting period requires that the ZMP must be within the supporting leg foot sole 
floor-contact area, etc. Due to rigid conditions of constraint such as this, it is difficult to determine the body acceleration 
20 and deceleration patterns. If the body patterns are determined mainly taking body position into account, the velocity 
would tend to be out of range, and vice versa. 

[0074] As stated, it has hitherto been difficult to generate or determine the desired gait parameters or table data, on 
a real-time basis, which will satisfy all of the possible gait conditions. The aforesaid prior art techniques described in 

the references could not effect free gait generation. 
25 [0075] 'Continuing the explanation of the gait, the gait is described by gait parameters. The gait parameters comprise 
motion parameters and the ZMP parameter (more generally floor reaction force parameter). The "floor reaction force 
parameter" is used In this specification to mean a parameter relating to the floor reaction force pattern with respect to 
time. 

[0076] The ZMP trajectory is expressed by a broken-line pattern as will be explained with reference to Figure 16 

30 (referred to only in the X-coordinate in the figure) and is described or expressed with respect to the coordinate of X, Y . 
and Z (directions) by the positions of the braking points and passing times of the pattern. 
[0077] The motion parameters compnse foot (trajectory) parameters and the body (trajectory) parameters. 
[0078] The foot trajectory parameters comprise Initial free leg (foot lifting) position and posture, terminal free leg (foot 
landing) position and posture, and durations of the two-leg supporting period and the one-leg supporting period, etc. 

35 Based on these, instantaneous values of the positions (xf, yf, zf) and posture (Oxf, 0yf, Gzf) of foot are determined in 
accordance with the techniques proposed earlier by the applicant in Japanese Laid-Open Patent Applications Hel 5 
(1 993) - 318339 and Hei 5 (1993)- 324115. Here, the word "posture" means inclination or direction in space. 
[0079] The body trajectory parameters comprise parameters determining the body posture (the direction or inclination 
of the body 24 in space), parameters determining the body height (value In the Z-direction), parameters determining 

40 initial body position (displacement) and velocity etc. . 

[0080] Based on the parameters determining the body position and posture, instantaneous values of the horizontal 
body position (xb, yb) and posture (Gxb, Gyb, Gzb) of the body are determined In accordance with time functions or the 
technique proposed eartier by the applicant in Japanese Laid-Open Patent Application Hei 5 (1993) - 324115. The 
height of body zb is determined using an appropriate technique such as that described in Japanese Laid-Open patent 

45 Application No. Hei 1 0 (1 998)-86080 proposed by the applicant. 

[0081] Since the robot 1 has 12 joints as illustrated In Figure 1 , desired joint displacements are solely determlnistlcally 
calculated by an inverse kinematic solution from the obtained feet position and posture and the body position and 
posture, as will be explained later. More specifically, the desired robot posture at the current time is solely determined. 
[0082] Aside from the above, since the generation of an ideal desired gait can not act against physical laws, a de- 

50 manded state can not be reached immediately. The transition to the demanded state should be achieved slowly by 
changing gait parameters such as the ZMP trajectory, landing position and landing time, etc., within pemriissible ranges. 
In particular, assuming the dynamic system of the biped robot in this embodiment as a system that inputs the ZIVIP and 
outputs the body position, it is a divergence system , Unless the gait parameter change is conducted carefully, it becomes 
difficult to restore to a normal state. 

55 [0083] Therefore, when generating a gait as desired on a real-time basis, it is preferable to predict robot's future 
behavior and to determine the gait parameters such that the robot's future behavior, e.g., a behavior at several walking 
steps from now does not diverge, and to correct the gait so as to avoid divergence if a possibility of occurrence of the 
divergence is predicted. 
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[0084] However, as discussed above, when the multiple-material-point model as shown in Figure 23 Is used, since 
the volume of calculation Is large and the system Is not linear, it Is quite difficult for a usual on-board CPU (mounted 
on the robot, i.e., the first arithmetic unit 60) to determine the gait terminal state on a real-time basis. And as regards 
the future behavior prediction and divergence prevention technique based thereon might be realized to a certain level, 

5 by, for example, storing various kinds of knowledge and by selecting a desired gait at every gait switching in response 
to the slal:e and objective al Lhal lime from the stored knowledge. In practice, however, a trial to cope with all possible 
condition would cause an explosion of combination, and this method would actually be impossible. 
[0085] In view of the above, it is configured such that a dynamic model that describes the dynamic behavior of the 
robot 1 Is simplified In such a way that future robot behavior can analytically be predicated in calculation on a real-time 

10 basis. Figure 6 shows the simplified robot dynamic model. As Illustrated, this dynamic model is three-materlal-point 
model and is decoupled, i.e., the dynamics of the leg and those of the body do not interfere with each other and the 
dynamics of the robot as a whole are expressed by their linear combination. Figure 6 is a block diagram showing 
dynamic calculation (conducted at a dynamic calculator in the gait generator 1 00) using the dynamic model illustrated 
In Figure 5. 

15 [0086] The dynamic model will be explained. 

1) This model comprises three material points made up of an inverted pendulum, a foot material point of the 
supporting leg and a foot material point of the free leg. 

2) The supporting leg foot material point Is set at a fixed point on a coordinate system set locally at the supporting 
20 leg foot. The coordinate system is a XYZ rectangular coordinate system in which the origin is defined on a sole of 

the foot, projected from the center of ankle onto the sole of the foot, the X-Y plane is equal to the sole and the X- 
axis Is defined as the direction from the heel to toe. This coordinate system Is hereinafter referred to as "supporting 
leg local coordinate system". A coordinate system on the fixed point on the supporting leg local coordinate system 
is hereinafter referred to as "supporting leg foot material point's offset". 
25 . Similarly, free leg foot material point Is set at a fixed point on a coordinate system that is set at the free leg 
foot. This coordinate system is hereinafter referred to as "free leg local coordinate system". A coordinate system 
on the fixed point on the free leg local coordinate system Is herein after referred to as "free leg foot materia! point's 
offset". 

A coordinate system whose origin Is defined on a foot point projected from the center of ankle onto the floor 
30 when the supporting leg foot Is entlrely in contact with the floor, and whose coordinate axes are fixed on the floor 

in such manner that the X-axis is defined as the front direction of the supporting leg foot, the Y-axis is defined in 
the left direction and the Z-axis is defined In the vertical direction, Is hereinafter referred to as "supporting leg 
coordinate system" (that Is different from the above-mentioned supporting leg local coordinate system. Unless It 
Is mentioned to the contrary, the position, the velocity, thefbrce, etc., are expressed by the supporting leg coordinate 
35 system. 

3) The inverted pendulum comprises a supporting point a that Is freely movable in the horizontal direction, a material 
point b and a link c that connects the supporting point and the material point. The link is expansible and has no 
mass, It Is assumed here that the link expands, when tilting, such that the height of the mass viewed from the 
supporting point is kept constant. The inverted pendulum is the same as a linear inverted pendulum of a robot 

40 disclosed in the aforesaid publication (Hel 4 (1992)-15068). 

The material point of the Inverted pendulum corresponds to the material point of the body 24 in the sense of 
physics (the body's material point does not always indicate the center of gravity). Accordingly, the material point 
• of the inverted pendulum Is the same as the material point of the body. The position (more broadly, the displace- 
ment) of the inverted pendulum's material point is simply referred to as "inverted pendulum position", 

45 4) The horizontal position of the body is geometrically determined from the Inverted pendulum's horizontal position. 

Specifically, It is determined such that a horizontal position (X-Y coordinate system viewed from the supporting 
leg coordinate system) of the representative point (hereinafter referred to as "body-representing point") on a co- 
ordinate system locally set at the body (the coordinate is hereinafter referred to as "body coordinate system") 
becomes equal to the inverted pendulum's horizontal position. More specifically, the body-representing point and 

50 . the Inverted pendulum's material point b are determined such that they are on the same vertical line, as Illustrated 
In Figure 6. A honzontal coordinate of the body-representing point on the body coordinate system is referred to 
as "body material point's offset". 

[0087] The description of vanables and parameters relating to the illustrated dynamic calculation model will then be 
55 explained. 

[0088] For ease of explanation, variables and parameters relating to the dynamic calculation model are defined and 
described as follows: 

[0089] The ZMP of the inverted pendulum shall be present at the supporting point a, since the ZMP is defined as a 
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point at which no moment is generated and the supporting point is free and hence no moment is generated there. 
Accordingly, since the inverted pendulum's supporting point can be regarded as the ZMP of the pendulum itself, it is 
referred to as "inverted pendulum's ZMP" and is, on and after, described or expressed as "ZMPpend". 
[0090] Mass and position of the individual material points are described as follows: 

5 

msup; supporLing leg's material point mass 
mswg; free leg's material point mass 

mb: inverted pendulum's material point mass (body's material point mass) 
mtotal: robot mass ( - mb + msup + mswg) 
10 mfeet: feet mass ( ^ msup 4- mswg) 

xsup: supporting leg's material point position 
xswg: free leg's material point position 

xb: inverted pendulum's position (body's material point position) 

15 [0091] On and after, xb is expressed by three-dimensional vector (XYZ coordinate system vector), if not mentioned 
to the contrary. The height of the inverted pendulum indicates the height from the supporting point to the material point 
and is described as h. 

[0092] d(xb)/dt Is the first order differential of xb and indicates the velocity of the inverted pendulum, whereas d2(xb) 
/dt2 is the second order differential of xb and indicates the acceleration of the inverted pendulum. The value g is a 
^ constant of the acceleration of gravity G is a vector of the acceleration of gravity and is defined as a vector whose X, 
Y components are 0 and Z component is - g. 

[0093] In the illustrated three-material-point model, moment of total Inertial force of the leg material point acting about 
a point of action P is defined as "leg's total inertial force moment about point P". Here, the resultant force of the inertial 
force and gravity Is hereinafter referred to "total inertia! force". The coordinate (or position) of the point of action P is 

25 described as xp, 

[0094] Eq. 1 , mentioned below, is an equation strictly defining, In terms of dynamics, of the leg's total inertial force 
moment about P 



30 leg's total Inertial force moment about P =:msup(xsup - xp) * G 

- msup(xsup - xp) d2(xsup)/dt2 + mswg(xswg - xp) ^ G 

- mswg(xswg - xp) * d2(xswg)/dt2 Eq. 1 

35 

[0095] The leg ZiVIP is described as ZMPfeet and Is defined by Eq. 2. The height of the leg ZMP (I.e., the Z component 
of ZMPfeet) is set to the same value as the height of the point P. Thus, the legZMP is a pseudo value to be corresponding 
to the resultant force (total inertial force) generated by the leg motion. 

leg's total inertial force moment about P =mfeet * (ZMPfeet - xp) * G Eq.2 



[0096] Inherently, the dynamics of the robot 1 illustrated In Figure 1 is non-linear. Therefore, by approximation, the 
relationship defined by Eq. 3 is given between the desired ZMP, the leg ZMP (ZMPfeet) and the inverted pendulum's 
45 ZMP (ZMPpend). 

ZMPpend=mtotal/mb * desired ZMP - mfeet/mb * ZMPfeet Eq. 3 

so [0097], Generally, the differential equation describing the behavior of a linear inverted pendulum is expressed by Eq. 4. 

d2(xb)/dt2's horizontal component 
55 = g/h * (xb's horizontal component - ZMPpend's horizontal component) Eq, 4 

[0098] Here, the point of action P is set to improve the accuracy of mode! approximation. For example, as illustrated 
in a time chart of Figure 7, the point of action P is set in such a manner that it moves, at the same speed during the 
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two-leg supporting period, from ttie origin of the supporting leg coordinate system of gait immediately before (iast time 
gait) to tliat of the current time gait. 

[0099] The dynamic model proposed in the gait generation system of legged mobile robot according to the embod- 
iment, is expressed by the offsets describing the relationship between the foot, the body and the material points illus- 
5 trated In Figure 5 and the equations (Eqs. 1 to 4). This configuration mal<es it easy to predict future behavior, as will 
be explained later. 

[01 00] Explaining the operation of the dynamic calculator of the gait generator 1 00 (illustrated in Figure 1) with ref- 
erence to Figure 6, it has a leg ZMP calculator 200. The calculator 200 calculates the leg ZMP (ZMPfeet) based on 
Eqs. 1 and 2 and on the point of action P illustrated in Figure 7. 

10 [0101] Then, it calculates the inverted pendulum's ZIVIP (ZMPpend) by multiplying the calculated ZMPfeet by mfeet/ 
mtotal, by subtracting the product from the desired ZMP, and by multiplying the difference by mtotal/mb. in other words, 
the inverted pendulum's, ZMP is determined or calculated by subtracting the product obtained by multiplying ZMPfeet 
(corresponding to or indicative of the leg ZMP) by a ratio between the leg's mass mfeet and the body material point's 
mass mb from the product obtained by multiplying the desired ZMP by a ratio of the robot mass mtotal and the body 

15 material point's mass mb. This processing corresponds to the processing of Eq. 3. 

[0102] The behavior of the inverted pendulum Is expressed by Eq. 4. The inverted pendulum matenal point's hori- 
zontal position xb Is determined or calculated. 

[01031: ■ Further, as illustrated in Figure 6, the dynamic calculator has a body position determlnator 202 which deter- 
mines the horizontal body position xb. Specifically, the determlnator 202 determines the horizontal body position in 
20 such a way that the horizontal position of the body-representing point (illustrated in Figure 5) is equal to the horizontal 
position of the inverted pendulum. 

[0104] Next, the gait for maintaining posture stability continuously will be explained. 
. [0105] ^ The dynamic model itself does merely calculate the body trajectory from the desired ZMP in such a manner 
that the dynamic equilibrium condition at each instant is approximately satisfied. It can riot prevent the body trajectory 
25 from diverging, it can not avoid the position of the body 24 from deviating from a position corresponding to the positions 
of the feet 22R(L), as illustrated in Figure 8. 

[0106] It will then be discussed how the relationship between the body and the feet is appropriately retained so as 
to avoid divergence. 

[0107] For ease of understanding, the nature of the linear inve,rted pendulurn that is especially significant for obtaining 
30 future body trajectory analytically will first be discussed. The explanation will be nriade with the use of a discrete-tlme- 
senes model. 

[0108] Variables and parameters will be additionally defined for the inverted pendulum as follows: 

0)0: natural angular frequency of inverted pendulum 
cdO = sqrt (g/h) (here, sqrt indicate square root) 
At: sample time 

x[k]; Inverted pendulum's position at k-th step (time kAt) 
v[k]: inverted pendulum's velocity at k-th step (time kAt) 

ZMPpend[k]: inverted pendulum's ZMP at k-th step (more precisely, it is assured that a signal obtained by O-order 
holding the ZMPpend[k] is and is kept inputted from time kAt to time (k-i-l)At. More specifically, it Is assumed that 
the same signal is kept inputted to the inverted pendulum durtng that time of period) 

[0109] Further, values q[k] and p[k] are defined by Eq. 5 as follows: 

q[k] = x[k) + v[k]/<o0 

p[k] = x[k] - v[k]/(oO Eq. 5 

50 [01101 By discretizing the equation of motion of the inverted pendulum and by solving with respect to q[k] and p[k], 
we obtain Eqs. 6 and 7. In the equations, "exp" indicates ah exponential function (natural logarithm). 



55 
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k-l 

p[k]-exp(-coOkAt)*(p[01+(exp(coOAt)- 1) J] Cexp(icoOAt) 

5 

*ZMPpend[i])) 

. . . Eq. 6 

iO 



q[k]-exp(G)OkAt)*(q[0]-f(exp(-(oOAt)-l) (exp( - ioOAt) 

f«0 



*ZMPpend[i])) 



Eq, 7 



20 [0111] The meaning of the equations will be discussed. 

[0112] Assume that ZMPpend[i] Is set to satisfy following Eq. 8 with respect to certain definite constants ZMPmin 
and ZlVIPmax. 

25 ZMPnnIn <ZMPpend[l] <ZMPnnax Eq. 8 

[0113] By substituting the relationship between the middle term and the right term of Eq. 8 into Eq. 6, we obtain 
following Eq. 9. 

30 

p[k] <exp( -coOk At)^ (p[0]+(exp(ooO At)-]) ^ (expCicoO At) 

1=0 

3s *ZMPinax)) 



... Eq. 9 



[01 14] From the theorem of sum of geometric series, we obtain Eq. 10. 

40 



k-i 

^ exp(icoO A t)Kl - exp(kcoO A t)) / (1 - exp(oO A t)) 

45 



Eq. 10 



[0115] Accordingly, Eq. 9 can be rewritten as Eq. 11 . 

50 

p[k] <exp( -wOkA t)*p[0]+(1 - exp( -o)OkAt)).*ZMPmax Eq. 1 1 

[0116] Similarly, from the relationship between the iefttermandthemiddleterm of Eq. 8 Into Eq. 6, we obtain Eq. 12. 

55 

p[k] > exp( -coOk At)*p[0]+(1 - exp( -o^Ok At))'^ ZMPmin Eq. 12 
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[0117] Since exp(-a)OkAt) converges (gradually approaches) to 0 when k becomes Infinity, Eqs. 11 and 12 show p[k] 
does not diverge and fall between ZMPmax and ZMPnnin in due course, even If ZMPpend fluctuates. 
[0118] Further, as a specific example, let us discuss a case that ZMPpend becomes a constant value ZMPO after 
lapse of a certain time. In that case, defining the time as time 0, Eq. 6 can be rewritten as Eq. 13. This indicates that 
5 p[k], Irrespectively of its Initial value, converges to ZMPO In a geometric series manner 

p[kl=:exp( -(oOkAt)'M(p[0] - ZIV1P0)+ZMP0 Eq. 13 

10 [01 19] More generally, It indicates that p[k], no matter what value It was at a certain time point, converges to a certain 
trajectory (that follows waveform of the ZMPpend) if the ZMPpend waveform is a same waveform. 
[0120] On the otiier hand, q[k] tends to diverge as will be understood frorn Eq. 7. 

[0121] As a specific example, let us again discuss the case that ZMI^pehd becomes a constant value ZMPO after 
lapse of a certain time. Defining the time as time 0, Eq. 7 can be rewritten as Eq. 14. This indicates that q[k] diverges 
15 to ZMPO In a geometric series manner, if q[0] Is ZMPO. 



q[k]=exp(coOkAt)'H(q[0]-ZMPO)+ZMPO Eq. 14 

2C? [0122] Hereinafter, p[k] defined by Eq. 5 Is referred to as "convergent component" and q[k] similarly defined by Eq. 
5 is referred to as "divergent component", 

[0123] From the above, it can be said that, in order to avoid divergence of the body trajectory and to retain an 
appropriate positional relationship between the body and feet, the convergent component can be neglected In practice, 
and what is significant is that to control the divergent component (viewed from the supporting leg) within a range that 
25 ensures robot walking. 

[0124] More specifically, it can be said that it is important to determine the ZMP trajectory parameters and other 
parameters appropriately such that the divergent component does not exceed the range that ensures robot walking (i. ^ 
e., the range that prevents posture from deviating markedly). Unless the body behavior Is made linear in the (d resent 
invention, it was impossible in the prior art to build equations where the divergent component and the convergent 
30 component are separated like Eqs. 6 and 7. Thus, it was not possible to make these discussions in the prior art. Now, 
it becomes possible in this embodiment. . 

[0125] . The nature of the convergent connpbnent and- divergent component will be explained. 
Nature 1 : Symmetry 

35 

[0126] The differences between the equations for obtaining the convergent component p[k] and the divergent com- 
ponent q[k] Is that p[k] is replaced with q[k] and thiat <oO is replaced with -0)0. 

Nature 2: Equivalent conversion 

40 

[0127] Since they are symmetric, the divergent component will only be discussed. 

[0128] Supposing as an Input a pulse expressed by ZMPpend[0] = UO and ZMPpend[i] = 0 (1= 1,2,...), q[k] at that 
case is obtained by substituting this ZMPpend[i] Into Eq. 7, as will be shown In Eq. 15. 

. q[k]=exp((oOkAt) (q[0]+(exp( -oOAt) - 1)U0) Eq. 15 

[0129] From this, considering the influence only upon the divergent component q[k], to input the Initial pulse UO will 
bring the same influence obtained by shifting the initial divergent component by UO*(exp(-oOAt)-1). In other words, the " 
50 initial pulse Is equivalently converted into the initial divergent component by multiplying by (exp(-a>0At)-1). 

[0130] Further, considering the influence only upon the divergent component q[k] by comparing Eqs. 7 and 15 with 
each other, influence caused by inputting ZMPpend[i] (1=0,1 ,2,..k-1) will bring the same influence as that obtained by 
the initial pulse input UO defined in Eq. 16, 

55 
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U0= (exp( -ooOi A t) * ZMPpendfi]) 

5 ■ . 

... Eq. 16 

[0131] Thus, the input ZMppend[i] (i=0, 1 , 2, ..k-1 ) is equivalently converted into tlie. initial pulse input 

10 ' 

Nature 3: Influence by time delay 

[0132] As Illustrated in Figure 9, assuming that ZI\^Ppend[l] is a function f(l), and that ZiyiPpend'[i] is a function f(i- 
nAt) which is obtained by delaying the function f(l) by a time nAt, and defining conversion of the input series ZMPpend 
15 [i] into the initial pulse as UO and conversion of the Input series ZmPpend'[i] into the Initial pulse as DO', UO' will be 
expressed as Eq. 17. 

UO'=UO*exp(- ncoOAt) " Eq. 17 

20 

[0133] In other words, the same waveform is inputted by delaying by the time nAt, the divergent component induced 
by the input is a value multiplied by exp(-no)OAt). 

[0134] Then, a divergent component obtained by inputting complicated waveform of the inverted pendulum's ZMP 
into the inverted pendulum model illustrated in Figure 5. 
25 [0135] The ZMP input given to the inverted pendulum of the dynamic model illustrated in Figure 5 (or Eq. 3) is a 
difference between the product of the desired ZMP and mtotal/mb, and the product of the leg ZMP and mfeet/mb. Since- 
the desired ZMP is specifically expressed by a waveform of broken line, the product of the desired ZMP and mtotal/ 
mb Is similarly expressed by a waveform of brol<en line. 

[0136] Therefore, principle and algorithm to analytically determine the divergent component induced by inputting the 
30 ZM P of broken-line waveform to the inverted pendulum will be explained. (The Influence of the leg ZMP will be described 
later.) Actually, the Inverted pendulum's ZMP moves on a two-dimensional space (horizontal plane). However, for ease 
of understanding, it is assumed that the ZMP moves along a linear space. 

[0137] Let us suppose a broken-llne as Illustrated In Figure 10 as the waveform of the Inverted pendulum's ZIVIP. 
Period I is defined as a period of time whose length is period[i] and the initial value is ZMP[i]. The principle and algorithm 

35 to obtain the divergent component generated by this ZMP will now be explained. 

[0138] Let us define a value as H(f(t), T) which is obtained by converting a divergent component (generated by 
continuously inputting x=:f(t) over the period of time [0,T] to the inverted pendulum model as the input of the inverted 
pendulum's ZMP), Into magnitude of pulse inputted at time 6 and time width is a sample time At. 
[0139] From Eq. 6, H(f(t), T) is expressed by product-sum calculation shown In Eq. 18. Ih the equation, co Indicates 

40 the natural angular frequency of the inverted pendulum). 



H(f(t),T)= 5] (kAt)exp(-c()kAt) 

• Eq. 18 

[0140] ■ The Inverted pendulum's ZMP's waveform In the period i can be dissolved into a step-like waveform and a 
so ramp-like waveform each having a delay, as Illustrated in Figure 11 . Accordingly, H(f(t), T) forthe step-like and ramp- 
like waveforms should be determined beforehand in a manner mentioned below. 

[0141] Specifically, describing H(f(t), T) of a step-like waveform of x=f(t)=1 as H(1 , T), it will be expressed as shown 
in Eq. 1 9, using the theorem of sum of geometric series. 

H(1 ,T)=(1 - exp( -cot)) / (1 - exp( -oiAt)) Eq. 1 9 

[0142] Describing H(f(t), T) of a ramp-like waveform of x=:f(t)=t as H(t, T), It will be expressed as shown in Eq. 20, 
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H(t,T)/T=(At>T*exp(-o>At)H(1,T)-exp(-o)t))/(1-exp(-o>At)) Eq. 20 

[0143] ■ it should be noted that if the ZMP waveform is other than the form of broken-line, other function f will be 
5 needed. There could sometime be no analytic solution of F(f(t), T) for the other function f. In that case, It will be sufficient 
If the function f Is normalized and H(f(t), T) Is then changed Lo a table data. The value F(r(l), T) in the above may also 
be changed to a table data. 

[0144] Having conducting these preparatory processing, a value (hereinafter referred to as "W"), which is obtained 
by converting a divergent component {generated by the inverted pendulum's ZlViP Illustrated in Figure 10), Into mag- 

10 nitude of Inverted pendulum's ZMP pulse inputted at time 0 and the time width Is a sample time At. 

[0145] First, influence of the inverted pendulum's ZMP during the period i (i = 0, 1 , ...5) should be converted into the 
magnitude of a pulse inf[l] inputted at the initial time of the period i and Its time width is the sample time At. As iilustrated 
in Figure 11 , the waveform of the inverted pendulum's ZIVIP during the period i is expressed by the sum of a rectangular 
waveform whose height is ZMP[i] and whose ^lope is (ZMP[i+1]-ZI\/lP[l])/period[i], the pulse conversion value will be 

15 as shown by Eq. 21 . 

■ ■ inf[l]=H(1, period[l])'KZMP[l] 
20 ' +H(t, perlod[l])/ period[l]*(ZMP[f+1]-ZMP[l]) Eq. 21 

[0146] Then, Influence of the inverted pendulum's ZMP during the period [I ](i = 0, 1 , ...m) should be converted into 
the magnitude of a pulse lnf[i] Inputted at the Initial time of the period i and Its time width Is the sample time At. From 
nature 3, the pulse conversion value will be as shown by Eq. 22. 

25 



inf[i]=inf[i]Hcexp(-"©0(^ period[k])) 

30 ' . ■ ' ■ . ■ ■ 

Eq, 22 

[0147] Influence of the Inverted pendulum's ZMP waveform during all of the periods illustrated in Figure 10, will be 
35 the sum of the influence of the individual periods . In other words, the pulse conversion value W is calculated as shown 
in Eq. 23. 



...Eq.23 

45 [01 48] From nature 2, when equivaiently convertingW into an initial divergent component, It will be as shown in Eq. 24. 

W*(exp(-a)0At)-1) Eq. 24 

50 [0149] From Eq. 24 ornatureS, when equivaiently converting W into the divergent component at gait terminal, It will 
be as shown in Eq, 25. 



W* (exp(-coOAt)- l)=^^exp((i)0(^ period[i])) 

...Eq.25 
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[01 50] Following the procedures mentioned above, it becomes possible to analytically obtain the divergent compo- 
nent at gait terminal induced by the inverted pendulum's ZMP expressed by a broken-like like waveform, 
[01 51 ] Then the gait generation algorithm that ensures continuous walking will be explained. 
[0152] As mentioned above, in order to avoid divergence of the body trajectory and to retain an appropriate positional 
s relationship between the body and feet, it is important to determine the ZM P trajectory parameters and other parameters 
appropriately such that the divergent component does not exceed the range that ensures robot walking (i.e., the range 
that prevents posture I'rom deviating markedly). 

[01 53] Next problem Is therefore how to determine the range that ensures robot walking or an appropriate value of 
the divergent value. 

10 [01 54] The gait generator 1 00 according to the embodiment determines an appropriate value of the divergent com- 
ponent by provisionally dotermining or setting a gait that is to be continuous to a current time gait now being generated. 
The gait that is to be continuous to the current time gait is hereinafter referred to as "steady turning gait" and will be 
explained later. 

[01 55] The operation of the gait generator 1 00 will be explained in detail. 

15 [0156] The gait generator inputs demand (demand value) concerning free leg foot's landing position and posture 
and landing time for next two walking steps, and determines the desired body position and posture trajectory, the 
desired foot position and posture trajectory and the desired ZIVIP trajectory. At this time, the gait parameters are partially 
corrected so as to ensure continuous walking. Hereinafter, the gaits being generated Is referred to as "current time 
gait", a gait succeeding thereto Is referred to as "next time gait" and a gait further succeeding thereto Is referred to as 

20 "next but one time gait". 

[0157] Figure 12 is a flow chart (structuralized flow chart) showing the gait generation of the gait generator 100. 
[0158] The program begins at S1 0 in which various kinds of initialization processing including initializing a time t to 
0 are conducted. The program then proceeds, via SI 2, to SI 4 in which timer interrupt at every control cycle is waited 
for. The control cycle (period) is At. The program then proceeds to S 1 6 in which it is determined whether the gait is at 

25 the time of switching. When the result is affirmative, the program proceeds to S18, whilst when the result is negative, 
the program proceeds to S20. 

[0159] When the program proceeds to S18, thetlme t is again initialized to 0. The program then proceeds to S22 In 
which a next time gait's supporting leg coordinate system, a next but onetime gait's supporting leg coordinate system 
and a current time gait period and a next time gait period are read. There values are corresponding to the aforesaid 
30 demand. They may be stored in the memory as a walking schedule or may be determined based on an instruction 
inputted from the joystick 44 or other operator apparatus and the history of walking up to that time. 
[01 60] The program then proceeds to S24 In which gait parameters of the current time gait are provisionally deter- 
mined. 

[0161] As regards the parameters, the current time gait's initial free leg position and posture are determined to be 
35 the current free leg foot position and posture viewed from the current time gait's supporting leg coordinate system (as 
the Initial values). The current time gait's initial supporting leg foot position and posture are determined to be the current 
supporting leg foot position and posture viewed from the current time gait's supporting leg coordinate system (as the 
initial values). The current time gait's temninal free leg foot position and postures are determined in response to the 
next time gait's supporting leg coordinate system viewed from the current time gait's supporting leg coordinate system. 
40 Specifically, they are determined in such a way that the foot position and posture of the free leg foot (obtained when 
rotated horizontally, without slippage, from terminal position and posture in the current gait, while keeping contact with 
the floor) will shift to the next gait's supporting leg coordinate system. 

[0162] The currenttime gait's terminal supporting leg foot position and posture are determined to position and posture 
where the foot is in surface contact with the floor so as not to slip (those are obtained by being rotated from the current 

45 supporting position and posture). As a result, if the floor is flat, the current time gait's terminal supporting ieg foot 
position and posture are equal to the current time gait's supporting leg coordinate system. In the gait mentioned here, 
although the supporting leg foot is made horizontal at the gait terminal, the foot may take other position and posture. 
[0163] The ZIVIP trajectory parameters of the current gait should be detemnined such that they are high in the margin 
of stability and do not change abruptly. The phrase "high in the margin of stability" indicates a condition where ZMP Is 

50 present at the center or thereabout in a minimum convex polygon (the so-called supporting polygon and is described 
In detail in Japanese Laid-Open Patent Application Hei 10 (1998)-86081 ). The determination of currenttime gait's ZMP 
trajectory parameters is provisional and they are subject to correction as v/iil be explained later. 
[0164] The program then proceeds to 826 in which gait parameters of the steady turning gait that is to be continuous 
to the current time gait is determined. It should be noted that the "steady turning gaif indicates a periodic gait that 

55 does not bring about discontinuity in motion at gait boundary when repeated. 

[01 65] Basically, the steady turning gait comprises the first turning gait and the second turning gait. The reason why 
the term "turning" is used is that, when the rate of turning is set to zero, since this indicates a straight advance, the 
term makes it possible to Include "straight advance" in "turning" in a broad sense. The steady turning gait is generated 
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by the gait generator 100 temporarily or tentatively in order to determine the divergent component at the current gait 
terminal. Therefore, the steady turning gait is not outputted from the gait generator 100. 

[0166] incidentally, when following the aforesaid definition tliat the gait comprises one wall<ing step that starts at the 
beginning of a two-leg supporting period and ends at the end of the one-leg supporting period succeeding thereto, the 

5 steady turning gait needs gaits for two wallclng. steps. Although it is possible to set the steady turning gait of a compii- 
caled form having a set of gaits for three walking steps or more, such a complicated gait setting Is tedious and the 
advantages and effecls are less than expected since the steady turning gall is only used for determining the divergent 
component at the terminal of the current time gait, If the legged mobile robot has three legs or more, the. number of 
gaits to define the turning will be increased In response thereto. 

10 [0167] In the gait setting, boundary conditions of the leg trajectory In the gait parameters of the first turning gait and 
the second turning gait are set or determined such that the leg trajectory is made continuous In the order of the current 
time gait, the first turning gait and the second turning gait. SpeQifically, the initial free leg foot position and posture of 
the first turning gait is set to be the terminal supporting leg foot position and posture of the current time gait viewed 
from the next time gait's coordinate system. The initial supporting leg position and posture of the first turning gait Is set 

15 to be the current time gait's terminal free leg position and posture viewed from the next time gait's supporting leg 
coordinate system. 

[0168] The terminal free leg foot position and posture of the first turning gait is, similarly to the determination of the 
current time gait's terminal free leg position and posture, set or determined In response to the next but one's time gait's 
supporting leg coordinate system viewed from the next time gait's supporting leg coordinate systenn. The terminal 

20 supporting leg position and posture of the first turning gait Is foot position and posture obtained by rotating, while 
keeping floor contact, the foot (set to the next time gait's supporting leg coordinate system) to be brought in surface 
contact with the floor so as not to slip. Therefore, If the floor surface is flat, the terminal supporting leg position and 
posture of the first turning gait become equal to those in the next time gait's supporting leg cobrdiriate system. 
[0169] The terminal free leg foot position and posture of the second turning gait are set or determined to be the same 

25 as the terminal free leg foot position and posture of the current gait viewed frbm the current time gait's supporting leg 
coordinate system. The terminal supporting leg position and posture of the second turning gait are set or determined 
to be same as those of the supporting leg foot position and posture of the current time gait vle^wed frohn the current 
time gait's supporting leg coordinate system/ • " • 

[01 70] Figure 13 Illustrates relationships among these gait parameters. 

30 [0171] The first turning gait and the second turning gait have the same walking period as that of the next time gait. 
(The waling period should necessarily be determined to be the same value, but should preferably be determined In 
response to the next time gait walking period.) Other motion parameters of the current time gait, the first turning gait 
and the second turning gait (including time parameters such as two-leg supporting period's length) should be deter- 
mined appropriately in response to the determined parameters mentioned above in such a way that they satisfy the 

35 conditions of gait (e.g., the velocity of the electric motors (actuators) are within permissible ranges.) 

[0172] The ZIVIP trajectory parameters of the first turning gait and the second turning gait should beset or determined 
such that they have high margin of stability and do not change abruptly. 

[0173] Aside from the above, If initial position and velocity of the body-representing position are set to values XO, 
VO, after having generated the aforesaid first turning gait and the second turning gait with the use of the simple model 
40 illustrated In Figure 5, the inltlaj position and velocity of the body-representing position when the first turning gait gen- 
eration is again started, become equal to the set values XO, VO. The values XO, VO are hereinafter referred tb as "body- 
representing point's initial position/velocity of the steady turning gait". The value XO should be described as "(xO, yO)", 
but the description of VO should be omitted. 

[0174] With this, when the first turning gait and the second turning gait are generated repeatedly using the simple 
45 model illustrated In Figure 5, the body-representing point's Initial position and velocity of the first turning gait are equal 
to the values XO, VO, unless there are accumulated calculation errors, in other words, the continuity of walking can be 
ensured. Divergent component at this time, i.e., XO+VO/((oO Is hereinafter referred to as "steady turning gait's Initial 
divergent component". 

[0175] Returning the explanation of Figure 12, the program then proceeds to S28 in which this steady turning gait's 
50 initial divergent component is determined. 

[0176] Figure 15 is a flow chart showing the steady turning gait's Initial divergent component at S28 of the flow chart 
of Figure 12. • 

[0177] Before entering the explanation of the figure, a principle for determining or calculating the steady turning gait's 
Initial divergent component will be mentioned. 
55 [0178] From Eqs. 3 and 7, it becomes possible to obtain following equation ( Eq. 26): In the equation, the desired 
ZMP is described as ZiVIPtotal. 
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q[kl=exp(c)o0k A t) * q[0] 

k-l 

+ exp(coOk At)* (-exp(<BO A t) - 1 ) ^ (exp( -coO At)* mtotal/mb 

*ZMPtotal[i])-exp(coOkAt)*(-exp(coOAt)-l) ^ (exp{ - ioO A t) 
* mfeet/mb * ZMPfeet[i]) 

.-.Eq.26 

[0179] Actually, every gait is expressed by the supporting leg coordinate system of tliat gait. fHowever, for ease of 

explanation, it is supposed that the first turning gait and the second turning gait are expressed by the first turning gait's 
supporting leg coordinate system and that a combination of the first turning gait and the second turning gait constitutes 
a single gait (steady turning gait). 

[0180] Determination of a divergent component q[l<] at the terminal of the steady turning gait by using Eq. 26 will 
then be explained. This divergent component Is hereinafter referred to as "terminal divergent component". The initial 
time of the steady turning gait is assumed to be time 0. The terminal time of the steady turning gait Is assumed to be 
time kAt. This terminal time Is corresponding to the time 0 of the next time gait. 

[0181] In this equation, the right first term indicates the terminal divergent component induced by the initial divergent 
component. The right second term indicates the terminal divergent component Induced by the desired ZMP pattern. 
The right third term indicates the terminal divergent component Induced by the leg motion. 

[0182] Since the desired ZMP pattern is expressed in the form of broken-line, the terminal divergent component 
induced by the desired ZMP pattern is determined analytically using the algorithm described by Eqs. 1 9, 20, 21 , 22, 
23 and 25 that determine the terminal divergent component induced by the aforesaid broken-line-like ZMPpend. The 
determined or obtained value is expressed as "Wzmptotal". It is a vector in two-dimension defined by the X and Y 
directions. 

[0183] Then, the terminal divergent component induced by the leg motion is determined. Its simplest way of deter- 
mination is to generate the leg motion in the gail generator from the aforesaid gait parameters of the steady turning 
gait, to detemriine ZmPfeet[i] (i = 0, 1,...k) from Eqs. 1 and 2, and to substitute it into the right third term of Eq. 26. 
Although the volume of calculation Is large, the calculation could be completed within the control cycle If there is used 
a microcomputer that has a high-performance but is still able to be mounted on the robot 1 . When the performance of 
microcomputer Is not high, -if sample time is set to be longer the control cycle when conducting the calculation, although 
slight calculation error will happen, the volume of calculation can also be decreased, 

[0184] The value, thus determined or obtained Is expressed as "Wfeet". it is also a vector in two-dimension defined 

by the X and Y directions. 

[0185] From the above, we obtain the following equation (Eq. 27): 

q[k]=exp({a)OkAt)*q[0)+Wzmptotal-i-Wfeet Eq. 27 

[0186] Here, expressing the terminal divergent component of the steady turning gait viewed from the supporting leg 
coordinate system of the gait next to the steady turning gait as q'[k], it must satisfy following equation (Eq. 28). 

q[0]=q'[k] Eq. 28 

[01 87] While, expressing supporting leg coordinate system of the gait next to the steady turning gait (X", Y" coordinate 
system In Figure 13) viewed from the supporting leg coordinate system of the steady turning gait (X', Y' coordinate 
system in Figure 1 3), by a rotation matrix M indicating rotation of the coordinate system and a parallel translation vector 
B indicating the origin coordinate of the coordinate system, it will be as shown in the following equation (Eq. 29). 
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q[k]=Mq'[k]+B 



Eq. 29 



[0188] From Eqs. 28 and 29, we obtain Eq. 30. 



5 



q[k]=Mq[0]+B 



. Eq. 30 



[0189] Further, from Eqs. 30 and 27, we obtain Eq. 31 . 



10 



Mq[0]+B=:exp(a>OkAt)*q[0]^-Wzmptotal+Wfeet 



Eq.31 



[0190] When expressing the inverse matrix of the matrix A as inv(A), we obtain Eq. 32 from Eq. 31 . In the equation, 
15 i indicates a unit matrix. 



20 [0191] Based on the principle of determination mentioned above, explaining the steady turning gaifs initial divergent 
component with reference to the flow chart of Figure 15, the program begins in SI 00 in which the terminal divergent 
component induced by the desired ZMP is determined in the manner mentioned above. The program then proceeds 
to SI 02 In which the terminal divergent component Induced by the leg motion is determined using the right third term 
of Eq. 26, and to SI 04 in which the steady turning gait's initial divergent component q[0] is determined using Eq. 32. 

25 The steady turning gait's initial divergent component q[0] Is a value viewed from the supporting leg coordinate system 
of the steady turning gait. The program then proceeds to S106 in which the steady turning gait's initial divergent cohi- 
ponent q[p] is converted into a value ylewed:from the supporting leg coordinate system of the current tinie gait. This 
value Is named q". ■ '^^r^ r^'-i ■ )•/::' :-:^ry-:^r'^ -^•!.:: :.■vV::::,s■■v:■-■:■^,^-'■■ • -v-::'^ ■ ■;..-. v . . 

[0192]: The next processing Is to correct the provisjonally-determined current time gait parameters such that thfe ■ ' 

30 terminal divergent component of the current time gait becomes equal to q". Since the processing is almost same as 
that In the steady turning gait, the variables, values and symbols will newly amended to be corresponding to those of 
the current time gait. 

[01 93] In this embodiment, the parameters correction is to be made only for the ZMP trajectory parameters. Although 

the other gait parameters may be corrected, since the relationship between a parameter correction amount and thfe ' 
35 terminal divergent component becomes normally non-linear, it is accordingly impossible to obtain the correction amou nt 
analytically. 

[0194] > The ZMP is corrected by adding a ZMP correction amount (correction amount or additive amount) to the 
provisionally-determined desired ZMP (hereinafter referred to as "provisional desired ZMP"). Figure 16 illustrates the 
relationship between them. 

40 [0195] As Illustrated in the figure, the desired ZMP parameter is corrected such that the desired ZMP (ZMPtotal) = 
the provisional desired ZMP + the ZPM correction amount. 

[0196] For ease of understanding, ail variables are assumed to be linear in the following. 

[0197] The ZMP correction amount is trapezoidal as shown in the middle of Figure 16 and Its height is expressed 
as "a". Since the relationship between the desired ZMP and the terminal divergent component is linear, the terminal 
45 divergent component Wzmptotal induced by the desired ZMP pattern can be expressed by Eq. 33. 



50 [0198] In the equation, Wzmptmp Indicates the terminal divergent component induced by the provisional desired 
ZMP of the current time gait. Wtrlm Indicates the terminal divergent component induced by the ZMP correction amount 
when a is set to be 1 . They are obtained or determined analytically in the manner of determining the terminal divergent 
component induced by the desired ZMP pattern of the steady turning gait. 

[0199] Since the terminal divergent component p[k] is p", we obtain Eq. 34 from Eqs. 27 and 33.- 



q[0]=inv(lVl - exp(coOkAt)l)(Wzmptotal+Wfeet - B) 



Eq.32 



Wzmptotal=Wzmptmp+a * Wtrlm 



Eq. 33 



55 



q"=exp(o)OkAt)*q[0]+Wzmptmp-i-a*Wtrim+Wfeet 



Eq. 34 
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[0200] Here, q[0] is the initial divergent component of the current tinne gait (i.e., initial inverted pendulum position + 
(initial inverted pendulum veloc[ty/a)0)). Accordingly, we obtain Eq. 35. 

^ a=(q" - exp((oOI<At)'i'q[0]-Wzmptmp-Wfeet) / Wtrim Eq. 35 

[0201] Finally, correcting the desired ZMP parameters sucli that the sum of the provisional desired ZMP and the 
ZiVl P correction amount becomes the desired ZM P, the terminal divergent component of the current time gait becomes 
equal to q" (that corresponds to the initial divergent component of the steady turning gait viewed from the current time 
10 gait). 

[0202] Returning to the explanation of the flow chart of Figure 12, the program proceeds to S30 in which the current 
time gait Is corrected. Specifically, the current time gait parameters are corrected such that the current time gait's 
terminal divergent component becomes equal to the steady turning gait's Initial divergent component q". 
[0203] Figure 1 7 is a flow chart showing the subroutine for correcting the current time gait parameters. 
15 [0204] Explaining it, the program begins In S200 in which the terminal divergent component Wzmptmp induced by 
the current time gait's provisional desired ZMP is determined. The program then proceeds to S202 in which the terminal 
divergent component Wtrim induced by the ZIVIP correction amount regarding a as 1 , is determined. 
[0205] The program then proceeds to S204 in which the tenninal divergent component Wfeet induced by the current 
time gait's leg motion Is determined, to S206 in which the current time gait's initial divergent component q[0] is deter- 
ge mined from the inverted pendulum's initial position and velocity and the trapezoidal height a is calculated by substituting 
the obtained q[0] into Eq. 35, The program then proceeds to S208 in which the desired ZiVIP parameters are corrected 
in the manner mentioned above. 

[0206] The foregoing is processing at the gait switching. 

[0207] Returning to the explanation of the flow chart of Figure 12, the program then proceeds to S20 In which in- 
25 stantaneous values of the current time gait are detemnined from the determined gait parameters, 
[0208] Figure 1 8 is a flow chart showing the subroutine for this, 

[0209] Explaining it, the program begins in 5300 in which the desired ZMP at time t Is determined based on the 
current time gait parameters, and proceeds to S302 in which the desired foot position and posture at the time t is 
determined based on the current time gait parameters. 
30 [0210] The program then proceeds to S304 in which the desired body posture at the time t is determined based on 
the current time gait parameters, to S306 in which the legZMP (ZMPfeet) at the time t is calculated from the desired 
foot position and posture at and before the time t using Eqs. 1 and 2. 

[0211] The program then proceeds to S308 in which the inverted pendulum's ZIVIP (ZMPpend) Is calculated using 
Eq. 3, to S310 in which the inverted pendulum's horizontal position Is calculated from the inverted pendulum's ZMP 

35 using Eq. 4. The program then proceeds to S31 2 in which the body's horizontal position is determined from the inverted 
pendulum's horizontal position. Specifically, as mentioned above, it is determined such that the body-representing 
point's horizontal position becomes equal to the horizontal position of the mass of the Inverted pendulum. Theprogram 
then proceeds to S314 in which the body height is determined using method of body height determination proposed 
in Japanese Lald-Open Patent Application Hei 10 (1998)-86080 proposed by the applicant. 

40 [0212] Again returning to the explanation of the flow chart of Figure 12, the program proceeds to S32 in which At Is 
added to the time t. and the program returns to SI 4 to repeat the procedures mentioned above. 
[0213] Additionally explaining the gait generation system according to this embodiment with reference to Figure 4, 
the desired gait Is generated in the gait generator 100 as mentioned above. Among of the gait parameters of the 
generated desired gait, the desired body position and posture (trajectory) are directly sent to a robot geometric model 

45 (inverse kinematic solution) 102. 

[0214] The rest of parameters Including the desired foot position and posture (trajectory), the desired total floor 
reaction force central point (i.e., the desired ZMP) (trajectory) and the desired total floor reaction force (trajectory) are 
directly sent to a composite compliance operation determinator 1 04. They are also sent to a desired floor reaction force 
distributor 1 06 In which the floor reaction force Is distributed to each foot (foot 22R(L) and the desired foot floor reaction 

50 force central point and the desired foot floor reaction force are determined and are sent to the composite compliance 
operation determinator 1 04. 

[0215] Corrected desired foot position and posture with deformation compensation (trajectory) are sent from the 
composite compliance operation determinator 1 04to the robot geometric model 1 02. Based on the inputs of the desired 
body position and posture (trajectory) and the corrected desired foot position and posture with deformation compen- 
55 sation (trajectory), the robot geometric model 1 02 calculates joint displacement command (values) on the twelvejoints 
(such as the joint 10R(L) so as to satisfy the trajectories and send the same to a displacement controller 108. The 
displacement controller 1 08 controls the displacement of the twelve joints of the robot 1 so as to follow the Joint dis- 
placement command (values) calculated by the robot geometric model 102. 
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[0216] The floor reaction force Induced In the robot by the joint displacement Is detected by an actual foot floor 
reaction force detector 110 (i.e., the force sensor 34), and the detected value Is sent to the composite compliance 
operation determinator 104. Posture inclination error Berrx or Berry is detected by the inclination sensor 36 and the 
detected value is s6nt to a posture stabilization controller 1 1 2 in which compensating total floor reaction force's moment 
s about the desired total floor reaction force central point is calculated for posture stabilization and is sentto the composite 
compliance operation determinator 1 04. The determinator 1 04 corrects the desired value(s) In response to the inputted 
value. 

[0217] Since the gist of the present Invention resides in the robot gait generation in the gait generator 1 00 and since 
the configuration and operation of the other components such as the composite compliance operation determinator 
io 1 04 are described in detail such as in Japanese Lald-Open Patent Application No. Hel 1 0 (1 998)-277969 proposed by 
the applicant, no further explanation will be made, 

[0218]. Having been configured in the foregoing manner, the gait generation system of a legged mobile robot accord- 
ing to the embodiment of the present invention can eliminate the aforesaid problems of Japanese Laid-Open Patent 
Application No. Hel 1 0 (1998)-86081 proposed by the applicant earlier,, and can generate a gait of any stride, turning 
15 angle and walking period, etc., that satisfies the dynamic equilibrium cohditioh, freely and on a real-time basis. In 
addition, it can generate a gait which ensures the displacement and velocity of each part of the robot continuous at a 
boundary between the next gait. 

[0219] ; These will be discussed more specifically. Figure 19 is a time chart showing a trajectory of the body-repre- 
senting.polnt in the Y-dlreetlon (I.e., the left and right directions). The gait generation system of a legged mobile robot 

20 according to this embodiment can generate a gait in such a way that the body-representing trajectory (marked by B) 
gradually approaches or converges to the body-representing trajectory of the steady turning gait (marked by A). 
[0220] Further, since the system simplify the dynamic model of the legged mobile so as to enhance the linearity, It 
can generate a gait by predicting future robot behavior. Furthernnore, since it can generate any other motion than the 
walking motion on a real-time basis, it can make the other motion to be continuous with the walking motion. 

25 [0221] It should be noted In the above that the three-materlal-poirit model illustrated in Figure 5 is not always indis- 
pensable, instead of the three-material-poirit model illustrated in Figure 5, the sihgle-mdterial-pbint model such M 
disclosed in Japanese Patent Publication No. Hpi 4 it wiil ' 

be equivalent to the value of leg nnibtion lo zerb iri thl^ embodirh AltHciugh tHe ac6^ drops, ^ 

since the divergent component induced by the leg motion becomes zero, the Volume of calculation decreases. - 

30 [0222] Figure 20 Is a subroutine flow chart, slniila^ Figure 16, but partially showing the calculation of the steady - ' 
turning gait'sNnitial divergent component in a gait jgeneratloh system of a legged hiobiie robot according to a second 
embodiment of the present invention. 

[0223] It Is stated in the first embodiment, that, Instead of the three-materlal-point model, a single-material-point 
model can be used. In the second embodiment, based on the supposition that the performance of the on-board CPU 
35 (first arithmetic unit 60) is markedly high, instead of the three-material-point model, there is used the mode! (illustrated 
- in Figure 23) in which every link is set with mass. In other vvbrds, a non-linear model Is used in the second embodiment 
to conduct gait generation. 

[0224] Explaining the operation of the system according to the second embodiment, after conducting the same pro- 
cedures as those shown from S10to S28, vlaS26, of the flow chart of Figure 12, the program proceeds to a subroutine 

40 flow chart of Figure 20 to determine the Initial divergent component of the steady turning gait. 

[0225] In the flow chart of Figure 20, the program begins in S400 In which the initial body position and velocity 
candidates (XO, VO) are provisionally detemnined. The body position and veiocity Indicate the position and velocity of 
the body-representing point. For ease of explanation, only the determination In the X-directiori Is discussed. Actually, 
however, the position and velocity should be searched in both the X and Y~directions simultaneously or separateiy. If 

45 they should be searched in the X and Y-directlons simultaneously, the space of search will be a quartlc-dlmension 
comprising an X-position, a Y-posltion, an X-veloclty and a Y-velocity. 

[0226] The program then proceeds, via S402, to S404 in which a gait from the time 0 to the terminal is generated 
based on the steady turning gait parameters regarding (XO, VO) as the initial states of the body, using the dynamic 
model (the non-linear model with every link set with a material point as illustrated in Figure 23). Specifically, by obtaining 
50 the desired ZMP, the desired foot position and posture and the desired body posture, by assuming the body's position 
and velocity as (XO, VO), and by using the dynamic model, the body trajectory to satisfy the desired ZMP Is generated. 
Similarly to the first embodiment, the gait generation is made only In the gait generator 1 00 and the generated gait IS 
not outputted therefrom, 

[0227] The program then proceeds to S406 in which the terminal body position and velocity of the generated gait 
55 are converted into values viewed from the supporting leg coordinate system of the next walking step (the same coor- 
dinate system as the X'", Y"'-coordinate system Illustrated in Figure 14), and detenriine or express the values as (Xe, 
Ve). 

[0228] The program then proceeds to S408 in which errors (errx, erry) between (XO, VO) and (Xe, Ve) are calculated 
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as illustrated. Since (XO, VO) and (Xe, Ve) must be equal to each other in the steady turning gait, a search should be 
made to decrease the difference therebetween becomes zero. 

[0229] The program then proceeds to S410 in which it is determined whether the determined errors are within indi- 
vidual permissible ranges. The permissible ranges indicates limits of deviation of the position and velocity at the bound- 
5 ary conditions. Instead of the permissible ranges, the configuration may be altered to determine whether an Initial 
divergent component (XO+VO/ooO) and an initial convergent component (XO-VO/wO) are within Individual permissible 
ranges. 

[0230] When the result in S41 0 is negative, the program proceeds to S412 in which a piuraiity of initial value candi- 
dates (XO+AXO, VO), (XO, VO+AVO) are determined around (XO, VO) and assuming the candidates as the initial body 
10 states, the gait is generated based on the gait parameters of the steady turning gait, and obtain (Xe+AXe1 , Ve+AVe1 ), 
(Xe-{-AXG2, Ve+AVe2) that are values obtained by converting the generated gait's terminal body position and velocity 
into values viewed from the supporting leg coordinate system in the next walking step. 

[0231] The program then proceeds to S414 in which next initial value candidates (XO, VO) are determined based on 
(XO, VO), the terminal body position and velocity relative to the initial value candidates thereabout and the aforesaid 
15 errors. 

[0232] These procedures are repeated insofar as the result in S41 0 is negative. On the other hand, when the result 
is affirmative, the program exits the repetitive loop (S402) and proceeds to S41 6 in which the steady turning gait's initial 
divergent component q[0] is determined using the equation illustrated there. The program then proceeds to S418 In 
which the same procedure as that Illustrated in S106 of Figure 15 in the first embodiment Is conducted. 

20 [0233] Although the linear three-materlal-point model as used In the first embodiriient is not used here, since the 
concept of the divergent component and the convergent component can similarly be applied to a perturbation amount 
in behavior of the non-linear model as disclosed in Figure 23, with sufficient accuracy of approximation, it is possible 
to define the divergent component using the same equations as those used in the first embodiment. 
[0234] The program then proceeds to a step, that is similar to S30 in Figure 12, In which the gait parameters of the 

25 current gait are corrected. 

[0235] Figure 21 a flow chart showing the subroutine for it. 

[0236] Explaining it, the program proceeds, via S500, to S502 in which the body position and velocity (Xe, Ve) at the 
terminal of the current time gait are determined based on the. provisional desired ZMP pattern and the other current 
time gait parameters by calculating the current time gait up to the temninal, and the temnlnal divergent component q[0] 

30 is calculated using the equation illustrated there. 

[0237] The programthen proceeds to S504 in which the terminal divergent component error errq is determined using 
the equation illustrated there, to S506 in which it is determined whether the error is within a permissible range. When 
the result is negative, the program proceeds to S508 In which the body position and velocity (Xe, Ve) at the current 
gait terminal are determined by calculating the cun-ent time gait up to the terminal based on the desired ZMP obtained 

35 by correcting the provisional desired ZMP pattern according to the relationship illustrated in Figure 1 6 regarding a as 
Aa, and a terminal divergent component ql [k] is determined using the equation illustrated there. In S508, Aa is a 
constant of an appropriately set fine value. The value Aa may be set such that it decrease as the en-orerrq decreases 
with repetitive calculation. Even it is set to a fixed constant, the error will be fallen within the permissible range by the 
repetitive calculation. 

^0 [0238] The program then proceeds to S51 0 in which a parameter sensitivity r is detemiined using the equation illus- 
trated there, to S512 In which a correction amount in the manner illustrated there is added to the provisional desired 
ZMP pattern to correct the same. 

[0239] These procedures are repeated insofar as the result in S506 is negative. When the result is affirmative, on 
the other hand, the program exits the repetitive loop (S500) and proceeds to S5i4 In which the provisional desired 

45 ZMP finally obtained is determined as the desired ZMP. 

[0240] Explaining the above, when the gait is generated in accordance with the current time gait parameters using 
the dynamic model and the gait is repetitively generated continuously in accordance with the steady turning gait pa- 
rameters, in orderto mal<e the generated gait to converge to the steady turning gait, the terminal divergent component 
of the current gait must completely or almost completely be equal to q" that is a value obtained by viewing the steady 

50 turning gait's initial divergent component q[0] from the current time gait's supporting leg coordinate system. 

[0241] In view of the above, also In the second embodiment, the desired ZMP pattern in the gait parameters of the 
current time gait is corrected to satisfy this condition. 

[0242] It should be noted that, also In the second embodiment, the current time gait parameters may be corrected 
such that body position and velocity are equal to each other at the steady gait boundary. However, comparing with the 
55 case that only the boundary condition relating to the divergent component should be satisfied, the conditions will be 
stricter the parameters to be corrected should be increased by two times and the search space will be Increased. 
[0243] It should also be noted that, if the body position and velocity should be made equal to each other by correcting 
the desired ZMP, waveform of ZIVIP correction amount will not be a simple trapezoidal such as shown in Figure 16. 



23 



BNSDOCID: <EPJ 1361027A1J..> 



EP 1 361 027 A1 



Rather, it will be a complicated form of two stage trapezoid, for example, and the correction amount will tend to increase. 
[0244] Explaining this again referring to Figure 19, as mentioned above, the trajectory marked by A indicates the 
body- rep resenting point trajectory in which the current time gait is generated such that body-representing point's po- 
sition and velocity are equal to each other at the boundary with the steady turning gait and then. the steady turning gait 
s Is generated. The trajectory marked by B indicates the body-representing point trajectory in which the current time gait 
is generated such that its terminal divergent becomes equal to q" and a continuous gail is repetitively generated using 
the steady turning gail parameters. ^ 

[0245] As illustrated, the trajectory B deviates from the trajectory at the boundary of the current time gait and the 
first steady turning gait, but, gradually approaches (converges to) the trajectory A in due course and becomes almost 
10 equal to'the trajectory A at the next steady turning gait. Thus, even the method of gait generation in which only the 
. divergent component is made equal to each other, can prevent gait divergence, similar to the method of gait generation 
in which even the position and velocity are made equal to each other. 

[0246] A trajectory marked by C indicates a trajectory in which the gait generation is conducted without paying any 
attention thereto. Such a trajectory will deviate from the trajectory A with respect to time. The method of gait generation 
15 to make even the position and velocity equal to each other is, in other words, that to make not only the divergent 

component but also the convergent component are made equal to each other Therefore, this method of gait generation 
in which even the position and velocity are made equal to each other is a specific example of the gait generation method 
in which only the divergent component is made equal to each other. 

[0247] Other parameters than the desired ZMP may be corrected (tills is the same as the first embodiment). For 

20 ease of explanation, only a linear search In the X-dlrectlon is described. Actually, the number of dimenslonis are in- 
creased as in the case of searching the initial value of the body position and velocity of the steady turning gait. 
[0248] In the second embodiment, although a pseudo Newton method (or the method for determining a Jacobian (i. 
e., sensitivity matrix) in (XO, VO) to determine the next candidate) Is used, other search method such as the simplex 
method can instead be used, Further, it is alternatively possible to conduct ealcuiations for search for the parameters 

25 . In advance to prepare them as mapped data. 

[0249] It should further be noted that the method of gait generation in the second embodiment using the non-linear 
model in a searching manner can be utilized to a linear model such as the three-material-point model (or the single- 
material-point model) used in the first embodiment to obtain the gait In an analytic manner. However, sinde the gait 
can be determined analytically, there is little advantage to Use such a searching method, that Is poor In efficiency. In 

30 conclusion, any dynamic model can be used, if it exhibits a sufficient accuracy of approximiation. 

[0250] In the first embodiment or in the second embodiment, if the gait is continually generated in line with the 
supposed steady turning gait, the ZMP correction amount Is zero, the determined desired ZIVIP generated as the current 
time gait Is equal to the ZMP (provisional desired ZMP) of the supposed steady turning gait. Since the ZMP of the 
steady turning gait is set to have high margin of stability, the current time gait has high margin of stability Insofar as = 

35 the gait generation is continued In line with the supposed turning gait. 

[0251] On the other hand, if it is attempted to generate a gait that is different. greatly from the steady turning gait 
supposed one walking step earlier, since the absolute value of the ZMP correction amount becomes large, the desired 
ZMP trajectory determined as the current time gait deviates markedly from an Ideal trajectory, the margin of stability 
becomes low. For example, if it is attempted to turn the robot to the right, the gait should be generated to shift the 

40 center of gravity to the right, if a demand is made to cause the robot to turn to the left abruptly at the next walking step , 
the desired ZMP trajectory must be shifted to the right large so as to shift the center of gravity from right to left. This 
lowers the margin of stability and the robot Is liable to turn over to the right. 

[0252] For that reason, the steady turning gait to be supposed should preferably set to be close to a gait that would 
be generated. To cause the robot to walk by the steady turning gait is a limited case and usually, a gait that deviates 
45 from the steady turning gait large will be generated. In the method of steady turning gait generation mentioned above, 
it is set to be close to a gait to be generated future. 

[0253] Methods of steady turning gait generation other than the above will then be explained In 1) to 4). Except for 
4), a deviation between the steady turning gait and a gait generated future Is liable to increase, but calculation Is made 
easier. 

50 . 

1 ) The next but one time's supporting leg coordinate system and the next but one time's walking period may be 

determined by prediction or extrapolation based on the current time supporting leg coordinate system, the current 
time's walking period and a waling history up to that time, based on the supposition that the walking velocity or 
turning velocity of the gait to be generated does not change abruptly. 
55 2) The steady turning gait may not necessarily be a straight walking gait. In that case, however, as the turning 

velocity Increases, the ZMP correction amount increases and hence, the margin of stability is lowered, 
3) The steady turning gait may be a standstill gait or a gait in which the robot Is kept standing but its feet are moved 
up and down in turn. As the walking speed Increases, the ZMP correction amount increases and the margin of 
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stability is lowsred. Tlie standstill gait indicates a stifl gait without movement. 

4) A transitional gait may be added or inserted between the current time gait and the steady turning gait, Although 
calculation for behavior prediction will be complicated, since the constraint condition (boundary condition) in de- 
termining the steady turning gait becomes loose and since it becomes possible to set steady turning gait more 
5 close to a desired one, It can further enhance the margin of stability. 

[0254] It is possible to combine 3) and 4). A gait generation system of a legged mobile robot according to a third 
embodiment of the present Is made with focus on this, 

[0255] Figure 22 is a view, similar to Figure 13, but showing partially the operation, more specifically, the setting of 
10 other steady turning gait, of the system according to the third embodiment. 

[0256] Specifically, as illustrated in Figure 22, the embodiment is configured in such a manner thatthe steady turning 

gait includes the standstill gait, and that the transitional gait (transition gait and includes any gait other than the steady 

turning gait) is inserted between the current time gait and the standstill gait (steady turning gait). 

[0257] Thus, by setting three gaits comprising the current time gait, the transitional gait and the standstill gait, It 
15 becomes possible to effectively prevent the posture divergence. Further, since the gait Is generated In such a way that 

the robot can shift to the standstill state at any time, It can realize a stopping motion with high margin of stability even 

when a sudden stop demand is made. 

[0258] More specifically, deeming the standstill gait as a kind of the steady turning gaits, the aforesaid algorithm of 
steady turning gait's initial divergent component should be used. However, since the body's material point velocity at 
20 stop Is 0, the divergent component Is always equal to the Inverted pendulum's material point position, Accordingly, the 
divergent component can be easily obtained without using the algorithm. 

[0259] Having been configured in the foregoing manner, the third embodiment can generate a gait having high margin 
of stability freely and on a real-time basis, similarly to the first embodiment and the second embodiment 
[0260] As stated in the above, the first to third embodiments are configured to have a system (gait generator 100) 
' 25 for generating a gait of a legged mobile robot 1 having at least a body 24 and a plurality of, more precisely two legs 
(leg iini<s) 2 each connected to the body, comprising: a dynamic model (illustrated in Figures 5 and 6) that expresses 
relationship between motion of the leg and the body, and a floor reaction force (more specifically, the ZMP); current 
time gait parameter provisionally-determining means (S24) for provisionally determining parameters of a current time 
gait including at least parameters determining a trajectory of the leg (desired foot position and posture) and a trajectory 

30 of the floor reaction force (desired total floor reaction force central point trajectory (desired ZMP trajectory)), in response 
to at least a demand (next time gait's supporting leg coordinate system, next but one time gait's supporting leg coor- 
dinate system, current time gait period, next time gait period, etc., S22); periodic gait parameter supposing means 
(S26) for supposing (or determining) the parameters of a periodic gait (steady turning gait) succeeding to the current 
time gait In response to at least the demand; current time gait parameter correcting means (S30, S200-S208)"for 

35 correcting at least the provisionally determined parameters of the current time gait such that the trajectory of the body 
(desired body position and posture trajectory) determined based on the dynamic model and the parameters of the 
current time gait and the periodic gait succeeding thereto substantially converges or becomes equal to a trajectory of 
the body of the periodic gait determined from the parameters of the periodic gait; and current time gait Instantaneous 
value determining means (S20, S300-S31 4) for determining Instantaneous values of the current time gait based on at 

40 least the corrected parameters of the current time gait. 

[0261] Further, they are configured to have a system (gait generator 1 00) for generating a gait of a legged mobile 
robot 1 having at least a body 24 and a plurality of, more precisely, two legs (leg links) 2 each connected to the body, 
comprising: a dynamic model (Illustrated in Figures 8 and 6) that expresses relationship between motion of the leg and 
the body, and a floor reaction force (more specrfically the ZMP); current time gait parameter provisionally-determining 

45 means (S24) for provisionally determining parameters of a current time gait including at least parameters determining 
a trajectory of the leg (desired foot position and posture trajectory) and a trajectory of the floor reaction force (desired 
total floor reaction force central point trajectory (desired ZMP trajectory)), in response to at least a demand {S22); 
periodic gait parameter supposing means (S26) for supposing (or determining) the parameters of a periodic gait (steady 
turning gait) succeeding to the current time gait in response to at least the demand; periodic gait boundary divergent 

50 component determining means (S28, S1 00-S1 06) for determining a periodic gait boundary divergent component (initial 
divergent component of the steady turning gait) that is a value Indicating a divergent component at gait boundary when 
behavior of the body of the periodic gait is approximated by the dynamic model, based on the parameters of the periodic 
gait; current time gait parameter correcting means (S30. S200-S208) for correcting the parameters of the current gait 
such that the divergent component becomes equal to or becomes substantially equal to each other at terminal of the 

55 current gait (terminal divergent component) generated with use of the dynamic model; and current time gait instanta- 
neous value determining means (S20, S300-S31 4) for determining Instantaneous values of the current time gait based 
on at least the corrected parameters of the current time gait. 

[0262] Further, it is configured that a transitional gait is inserted between the current time gait and the periodic gait 
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succeeding thereto. 

[0263] Further, it is configured that the transitional gait includes a standstill gait. 

[0264] Further, they are configured to have a systenn (gait generator 100) for generating a gait of a legged mobile 
robot 1 having at least a body 24 and a plurality of, more precisely, two legs (leg links) 2 each connected to the body, 

5 connprlslng: leg reaction force calculating means (leg ZIVIP calculator 200, S20, S306) for calculating a leg reaction 
force, more specifically, a leg ZMP (ZMPfeet) that is a resultant force (iolal inerlial force) of inerlial force and gravity 
Induced by a motion of the leg, without depending on behavior of the body; inverted pendulum model supporting point 
position calculating means (S20, S308) for calculating a position of a supporting point of an inverted pendulum (ZMP- 
pend) that describes dynamic behavior of the body, from at least the calculated leg reaction force and a desired floor 

io reaction force (more specifically, a desired ZMP); Inverted pendulum displacement calculating means (S20, S310) for 
calculating displacement of the inverted pendulum, more precisely, the Inverted pendulum's material point position 
(inverted pendulum's horizontal position xb) based on at least the calculated position of the supporting point of the 
Inverted pendulum; body position calculating means (body position d ©terminator 202 ^ S20, S312, S314) for calculating 
a position of the body, more precisely, a body's horizontal position based on at least the calculated displacement of 

15 the inverted pendulum; and gait generating means (S20, S300-S31 4, gait generator 1 00) for generating a gait based 
on at least the calculated position of the body. 

[0265] They are configured to have a system (gait generator 100) for generating a gait of a legged mobile robot 1 
having at least a body 24 and a plurality of, more precisely, two legs (leg links) 2 each connected to the body, comprising: 
leg ZMP calculating means (leg ZMP calculator 200, S20, 3306) for calculating a leg ZMP (ZMPpend) that Is corre- 

20 spending to a ZMP of the leg that is a pseudo value of a resultant force of inertlal force and gravity Induced by a motion 
of the leg, without depending on behavior of the body; inverted pendulum model supporting point position calculating 
means (S20, S308) for calculating a position of a supporting point of an inverted pendulum (ZMPpend) that describes 
dynamic behavior of the body, from at least the calculated ZMP and a desired ZMP; inverted pendulum displacement 
calculating means (S20, S31 0) for calculating displacement of the Inverted pendulum, more specifically, the Inverted 

25 pendulum's material point position (inverted pendulum's horizontal position xb) based on at leastthe calculated position 
of the supporting point of the Inverted pendulum; body position calculating means (S20, S312, S314, body position 
determlnator 202) for calculating a position of the body based on at least the calculated, displacement of the inverted 
pendulum; and gait generating means (S20, S300-S314, gait generator 100) for gdheratiri^ a gait based on at least 
the calculated position of the bodyi^:-::— '■ ■v-^^: -vv^ ^ ; - v.,;- :> -vrc-;:^:,- •;. ^ .-. 

30 [0266] Further, it Is configured that the Inverting fbendulurn model supporting point calculating means calculates the 
supporting point of the inverted pendulum (inverted pendu lum's horizontal position xb) by subtracting a product obtained 
by multiplying the. leg ZMP by a second coefficient mfeet/mtotal from a product obtained by multiplying the desired 
ZMP by a first coefficient mtotal/mb. 

[0267] Further, they are configured to have a system (gait generator 1 00) for generating a gait of a legged mobile 

35 robot 1 having at least a body 24 and a plurality of, more precisely, two legs (leg links) 2 each connected to the body, 
" comprising: a dynamic model having; a leg reaction force calculating means (leg ZMP calculator 200, S20, S306) for 
calculating a leg reaction force (leg ZMP (ZMPfeet)) that is a resultant force of Inertlal force and gravity induced by a 
motion of the leg, without depending on behavior of the body; Inverted pendulum model supporting point position 
calculating means (S20, S308) for calculating a position of a supporting point of an inverted pendulum (inverted pon- 

40 ■ du lum's ZMP (ZMPpend)) that describes dynamic behavior of the body, from at least the calculated leg reaction force 
and a desired floor reaction force (desired ZMP); inverted pendulum displacement calculating means (S20, 531 0) for 
calculating displacement of the inverted pendulum based on at least the calculated position of the supporting point of 
the inverted pendulum, more precisely position (inverted pendulum's horizontal position); and body position calculating 
means (body position determlnator 202, S2G, S312, S314) for calculating a position of the body (body's horizontal 

45 position) based on at least the calculated displacement of the inverted pendulum; current time gait parameter provi- 
sionally-determining means (S24) for provisionally determining parameters of a current time gait including at least 
parameters determining a trajectory of the leg (desired foot position and posture trajectory) and a trajectojy of the floor 
reaction force (desired total floor reaction force central point trajectory (desired ZMP trajectory)), in response to at least 
a demand (S22); periodic gait parameter supposing means (S26) for supposing the parameters of a periodic gait 

50 (steady turning gait) succeeding to the current time gait in response to at least the demand; periodic gait boundary 
divergent component determining means (S2B, S100-S106) for determining a periodic gait boundary divergent com- 
ponentthat is a value indicating a divergent component (steady turning gait's initial divergent component) at gait bound- 
ary when behavior of the body of the periodic gait is approximated by the dynamic model, based on the parameters 
of the periodic gait; current time gait parameter correcting means (S30, 5200-5208) for correcting the parameters of 

55 the current gait such that the divergent component becomes equal to or becomes substantially equal to each other at 
terminal of the current gait (current time gait's terminal divergent component) geherated with use of the dynamic model; 
and current time gait instantaneous value determining means (S20, 3300-331 4) for determining Instantaneous values 
of the current time gait based on at least the corrected parameters of the current time gait. 
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[0268] Further, it is configured that the floor reaction force Includes at least aZMP and the Inverted pendulum (Illus- 
trated in Figures 5 and 6) is a linear model. 

[0269] Next, the calculation of the leg ZMP (ZMPfeet) will additionally be commented. 

[0270] It is preferable for the leg ZMP (ZMPfeet) determining function to satisfy the following conditions (tliat In the 
s first embodiment can satisfy all of the conditions): 

Condition a) It should be determined based on all or a part of the gait parameters thai determine the foot LrajecLory. 
Condition b) It should not be influenced by the motion of the body-representing point. 
Condition c) The accuracy of approximation of a simplified model should be sufficiently high. 
io Condition d) It should be continuous as much as possible (so as to make the body acceleration continuous.) 

[0271] Among of them, Conditions a) and b) are those for facilitating the predictive calculation. In the embodiments, 
the leg ZMP is obtained from Eqs, 1 and 2. It may Instead be obtained from Eq. 1 and the following equations (Eqs. 
36 and 37) 



15 



20 



25 



leg's total inertial force moment about point P = mfeet* (ZMPfeet - xp) 

'!^(G - C^i^afeetz) Eq. 36 

[0272] In the equation, C is a constant. From Eq, 37, feet's center of gravity's acceleration vector afeet is obtained, 
"afeetz" in Eq. 36 indicates the feet's center of gravity's vertical-directional acceleration vector that is corresponding 
to the vector afeet with its X and Y components are made zero. 

afeet=(msup*d2(xsup)/dt2+mswg*d2(xswg)/dt2) / (msup+mswg) Eq. 37 



[0273] Since the degree of adjustment of Eq. 36 is higher than that of Eq. 2, it can enhance the accuracy of approx- 
imation. In Eq. 1 for calculating the leg's total inertial force moment about the point P, the term relating to tine leg 
30 acceleration can be multiplied by the constant as disclosed. Although the equation is changed to be incorrect in the 
sense of dynamics, insofar as the accuracy of approximation of the simplified model is enhanced, it is possible. 
[0274] Then, the setting of the point of action P will be commented. 
[0275] The point of action P may be set as follows: 

35 1 ) to set the point of action P at the origin of supporting leg coordinate system of tlie current time gait or a prede- 

termined point thereabout. 

2) to set the point of action P such that it moves continuously during the two-leg supporting period from the last 
time (just before the current time) gait's supporting leg coordinates system' origin or a predetennlned point there- 
about to the current time gait's supporting leg coordinate system's origin or a predetermined point thereabout, 
40 3) to set the point of action P such that it becomes equal to the provisional desired ZMP trajectory. 

[0276] Their characteristic features will additionally be commented. 

[0277] As regards 1), since the point of action P becomes discontinuous relative to the leg position (i.e., becomes 
discontinuous when viewing from the absolute coordinate system fixed on thefloor), ZMPfeet does disadvantageously 
45 become discontinuous relative to the leg position (i.e., becomes discontinuous when viewing from the absolute coor- 
dinate system). However, if the coordinate system Is switched during the two-leg period where the feet acceleration Is 
not so large, the magnitude of discontinuity will yield little problem In wall<ing. 

[0278] As regards 2), its accuracy of approximation is better than 1). Further, since the point of action P becomes 
continuous relative to the leg position, ZMPfeet does accordingly become continuous relative to the leg position. 
50 [0279] As regards 3), its accuracy of approximation is more improved than 2). Further, like 2), ZMPfeet is continuous 
relative to the leg position, 

[0280] Then, the calculation of leg's total inertial force moment will additionally be commented. 
[0281] The foot material point trajectory is a trajectory determined from the foot motion parameters, Ttie trajectory 
of the foot position and posture to be used in determining the foot material point trajectory need not be equal to the 
55 foot position and posture in the desired gait outputted from the gait generator 1 00. For example, if the foot in Xhe desired 
gait should rotate, the foot position and posture trajectory to be used In determining the foot material point trajectory 
may be a trajectory in which the foot is kept inorizontal. Unless the accuracy is degraded greatly, the amount of foot 
lifting or some similar parameters may be altered in the trajectory. 
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[0282] The leg material point may be set as follows: 

1) to set at a predetermined point in the foot; 

2) to set at a point shifted vertically from the aforesaid predetermined point by a prescribed distance; 
5 3) to set at a plurality of points (n the foot. The foot may set with Inertia. 

[0283] Any of the above can satisfy the aforesaid Condition b). 

[0284] Additionally commenting on the setting of the material point offset of the body and leg, if the material point 
offset values of the body and leg may be set to fixed values, there will yield little problem. Alternatively, they may be 
corrected In response to the gait parameters in order to decrease the modeling error of the center of gravity as little 
as possible. Although the horizontal position of the inverted pendulum is made corresponding to the horizontal position 
of the body-representing point, It may alternatively be made to be corresponding to the center of gravity of the robot, 
as a whole, or to the center of gravity of the robot excluding legs or a leg. 

[0285] Although the height of the Inverted pendulum may be changed In response to the gait parameters, It Is pref- 
15 erable to set the height to a fixed value during a short period of time (such as during one wal<ing step) in order to 
facilitate future behavior prediction. , 

[0286] Additionally commenting on the calculation of the divergent component induced by the leg motion, the diver- 
gent component Induced by the leg motion may be detennined directly from the gait parameters in an approximation 
manned, without generating the leg motion at every control cycle. For example, by approximating that the leg ZMP is 

20 at an average value between the feet's center of gravity at the initial of the gait and that at the terminal of the gait during 
one step wall<ing, a product obtained by multiplying the average value with H(1 , T) will be a value that approximates 
a value obtained by converting the divergent component induced by the leg motion by Into impulse at time 0. 
[0287] The terminal divergent component induced by the leg motion Is expressed by a function that inputs the gait 
parameters (in particular, the leg motion parameter and time parameter). Accordingly, if mapped data that shows the 

25 relationship between the gait parameters and the terminal divergent component induced by the leg motion, the volume 
of calculation will be decreased, although additibnal capacity of memory is needed. Either method can be utilized. 
[0288] It will be possible to combine these aforesaid alternatives together For example, the method of leg ZMP 
calculation to calculate the ZMP cbrrectloh airiouht (in predicting future behaV^ of leg ZMP calculatiori • 

to calculate the instantaneous value in the current control cycle n^ed not be strictly eqU^I to each other. SIhce the 

30 influence of the Initial divergent component is taken Into account when calculaiting the ZMP cofrectioh amount, if the 
divergent component deviates by a small difference (occurring between them)i a correction will be made to suppress 
the divergence when conducting gait generation in the next walking Step. 

[0289] It should be noted that, although the gait Is corrected or changed when the timet Is zero In SI 0 In the flow 
chart of Figure 12 in the first embodiment, the gait may be corrected or changed at any time other than that. If doing 
35. so, it suffices if the current time is' deemed as the initial time of the current time gait. In other words, It suffices if a 
period of time of the current time gait is ranged from the current time to the current time gait's terminal. . 
[0290] It should further be noted that the block diagram illustrated In Figure 6 may be altered insofar as equivalent 
operation Is possible." 

[0291] In the foregoing embodiments, although the present invention has been described with reference to a biped 
40 robot, the present invention can also be applied to any other legged mobile robots having legs of three or more. 

INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

[0292] According to the present Invention, there is provided a gait generation system of a legged mobile robot that 
45 has the dynamic model expressing the relationship between the motion of the body and leg and the floor reaction force, 
and provisionally determines the current time gait parameters including at least parametersthatdetemnine leg trajectory 
and the like in response to a demand, corrects the currenttime gait parameters such that the body trajectory (determined 
based on the dynamic model and the parameters of the current time gait and a periodic gait succeeding thereto) 
substantially converges or becomes equal to a body trajectory determined from the parameters of the periodic gait, 
50 and determines instantaneous values of the current time gait based on the corrected current time gait parameter. With 
this, the system can generate, freely and on a real-time basis, a gait of any stride, turning angie and walking period, 
including the floor reaction force acting on the legged mobile robot, that satisfies the dynamic equilibrium condition. 
[0293] Further, the system can generates a gait in such a manner that the displacement and velocity of each robot 
part are continues at the boundary of the generated gait and that succeeding thereto, can generate a gait that is high 
55 in the margin of stability, can predict future behavior of the robot to generate a gait such that no disadvantages such 
as posture divergence occurs. Furthenmore, the system can ensure real-time gait generation with high speed calcula- 
tion. 
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Claims 

1 . A system for generating a gait of a legged mobile robot iiaving at ieast abody and a plurality of legs each connected 
to the body, connprlsing: 

5 

a, a dynamic model that expresses relationship between motion of the leg and the body, and a floor reaction 
force; 

b. current time gait parameter provisionally-determining means for provisionaily determining parameters of a 
current time gait including at least parameters determining a trajectory of the leg and a trajectory of the floor 

10 reaction force, in response to at least a demand; 

G. periodic gait parameter supposing means for supposing the parameters of a periodic gait succeeding to the 
current time gait in response to at least the demand; 

d. current time gait parameter correcting means for connecting at least the provisionally determined parameters 
of the current time gait such that the trajectory of the body determined based on the dynamic model and the 

15 parameters of the current tinne gait and the periodic gait succeeding thereto substantially converges or be- 

comes equal to a trajectory of the body of the periodic gait determined from the parameters of the periodic 
gait; and 

e. currenttime gait Instantaneous value determining means for detemnining instantaneous values of the current 
time gait based on at least the corrected parameters of the current time gait. 

20 

2. A system for generating a gait of a legged mobile robot having at least abody and a plurality of legs each connected 
to the body, comprising: 

a. a dynamic model that expresses relationship between motion of the leg and the body, and a floor reaction 
25 force; 

b. current time gait parameter provisionaily-determining means for provisionally determining parameters of a 
currenttime gait including at least parameters determining a trajectory of the leg and a trajectory of the floor 
reaction force, In response to at least a demand; 

c. periodic gait parameter supposing means for supposing the parameters of a periodic gait succeeding to the 
30 current time gait In response to at least the demand; 

d. periodic gait boundary divergent component determining means for determining a periodic gait boundary 
divergent component that is a value indicating a divergent component at gait boundary when behavior of the 
body of the periodic gait is approximated by the dynamic model, based on the parameters of the periodic gait; 

e. currenttime gait parameter correcting means for correcting the parameters of the current gait such that the 
35 divergent component becomes equal to or becomes substantially equal to each other at terminal of the current 

gait generated with use of the dynamic model; and 

f. current time gait instantaneous value determining means.for determining Instantaneous values of the current 
time gait based on at least the corrected parameters of the currert time gait. 

3. A system according to claim 1 or 2, wherein a transitional gait is inserted between the current time gait and the 
periodic gait succeeding thereto. 

4. A system according to claim 3, wherein the transitional gait includes a standstill gait. 

'^5 5. A system for generating a gait of a legged mobile robot having at ieast a body and a plurality of legs each connected 
to the body, comprising: 

a. leg reaction force calculating means for calculating a leg reaction force that is a resultant force of inertial 
force and gravity induced by a motion of the leg, without depending on behavior of the body; 
50 b. inverted pendulum model supporting point position calculating means for calculating a position of a sup- 

porting point of an inverted pendulum that describes dynamic behavior of the body, from at least the calculated 

leg reaction force and a desired floor reaction force; 

c. inverted pendulum displacement calculating means for calculating displacement of the inverted pendulum 
based on at least the calculated position of the supporting point of the inverted pendulum; 
55 d. body position calculating means for calculating a position of the body based on at least the calculated 

displacement of the inverted pendulum; and 

e. gait generating means for generating a gait based on at least the calculated position of the body 
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6. A system for generating a gait of a legged mobile robot having at least a body and a plurality of legs each connected 
to the body, comprising: . 

a. leg ZMP calculating means for calculating a leg ZMP that is corresponding to a ZMP of the leg that is a 
5 pseudo value of a resultant force of Inertial force and gravity Induced by a motion of the leg, without depending 

on behavior of the body; 

b. inverted pendulum model supporling point position calculating means for calculating a position of a sup- 
porting point of an inverted pendulum that describes dynamic behavior of the body, from at least the calculated 
ZMP and a desired ZIVIP; 

io c. Inverted pendulum displacement calculating means for calculating displacement of the inverted pendulum 

based on at least the calculated position of the supporting point of the Inverted pendulum; 

d. body position calculating means for calculating a position of the body based on at least the calculated 
displacement of the inverted pendulurh; and 

e. gait generating means for generating a gait based on at least the calculated position of the body. 

15 

7. A system according to claim 6, wherein the inverting pendulum model supporting point calculating means calculates 
the supporting point of the inverted pendulum by subtracting a product obtained by multiplying the leg ZMP by a 
second coefficient from a product obtained by multiplying the desired ZMP by a first coefficient. 

20 8. A system for generating a gait of a legged mobile robot having at least a body and a plurality of legs each connected 
to the body, comprising: 

a. a dynamic model having; 

a leg reaction force calculating means for calculating a leg reaction force that is a resultant force of 
25 inertial force and gravity induced by a motion of the leg, without depending on behavior of the body; 

inverted pendulum model supporting point position calculating means for calculating a position of a sup- 
porting point of an inverted pendulurp that describes dynamic behavior of the body, from at least the qalculated 
leg reaction force and a desired floor reaction force; - = . :rr -r^^ - 

inverted pendulum displacement caiculatihg hieans for calculating displacement of t^ pendu- 
30 lum based on at least the calculated position of the supporting point of the Inverted pendulum; and ' ^ 

body position calculating means for calculating a position of the body based on at least the calculated 
displacement of the Inverted pendulum;/ 

b. current time gait parameter provisionally-determining means for provisionally detemilning parameters of a 
current time gait Including at least parariieters determining a trajectory of the leg and a trajectory of the floor 

35 reaction force, in response to at least a demand; 

c. periodic gait parameter supposing means for supposing the parameters of a periodic gait succeeding to the 
current time gait In response to at least the demand; 

d. periodic gait boundary divergent component determining means for determining a periodi6 gait boundary 
divergent component that is a value Indicating a divergent component at gait boundary when behavior of the 

40 body of the periodic gait is approximated by the dynamic models based on the parameters of the periodic gait; 

e. current time gait parameter correcting means for correcting the parameters of the current gait such that the 
divergent component becomes equal to or becomes substantially equal to each other at terminal of the current 
gait generated with use of the dynamic model; and 

f. current time gait instantaneous value determining means for determining Instantaneous values of the current 
45 time gait based on at least the corrected parameters of the current time gait. 

9. A system according to any of claims 1 to 5 and 8, wherein the floor reaction force Includes at least a ZMP. 

10. A system according to any of claims 1 to 9, wherein the inverted pendulum Is a linear model. 

50 
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FIG. 1 
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FIG. 2 
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FIG. 3 



26 



1ST 
ARITE^MEHC 
UNTT 



J 



60 50 



■ 2ND ^ 



ARITHMETIC 
UNIT 



62 



ROM 



RAM 



52- 



64 



54 



A/D 



56 



COUNTER 



66 



D/A 



JOYSTICK - 



INCLINATION 
SENSOR 



FORCE 
SENSOR 



44 

_ 36 
-34 



ENCODERS 



MOTORS 



- SER.VO- AMPLIFIERS 



33 



BNSDOCID: <EP 1361027A1 _L> 



FIG.4 



L 



100 



DESIRED BODY POSmOK/POSTURE TRAJECTORY 



m 

GENER- 
ATOR 



DESIRED FOOT POSmON/POSTORE 
TRAJECTORY ' 



DESH/eD TOTAL FLOOR 
REACnONFORCE CENTRAL 
POINT TRAJECTORY 
sDBSIREDZMP) 



DESIRED TOTAL FLOOR 
REACTION FORCE . 
TRAJECTORY 



GAIT 

PARAMETERS 



DESIRED 
FOOT FLOOR 
EACTION 
FORCE 
CENTRAL 



DESIRED 
FLOOR 
REACTION POINT 
FORCE 
DISTRBU- 
IDR 



COMPOSIIE 
COMPLI- 
ANCE 

OPERATION 
DETERNflNA- 
TOR 



DESIRED 
FOOT 
FLOOR 
REACHON 
FORCE 



106 



104-^ 



L 



102 



ROBOT 
GEOMMC 
MODE : 
(INVERSE: : 
MMATiC 
SOLUTION) 



CORRECTED 
DESIREDFOOT 
POSfflONffOSTURE .: 
(W/TDBFORMATION 
COMPENSATION) 
1AJECT0RY liiQ 

ACTUALFOOT- \ 
FLOOR — ^ 
REACTION 
FORCE 



JOINTDISPLACEMENr 
GOMMAM) 



DISPLACEMENT 
CONTROLLER 



10? 



ACTUAL ROBOT ■ 
INCLINATION ERROR 
EEAHVETO 
DESIED POSTURE 
(GEOMETRICMODE 
POSTURE) Serrx 

flerry 



ACTUATOR 
DRIVING 
FORCE ^ 

, ACTUAL 
ROBOT 



ACIUALFOOr 
FLOOR REACTION 
FORCE SENSOR 



ACTUAL 
JOINT 
DISPLACE- 
MENT 



COMPENSATING 
TOTAiaOOR 
REACTION 
FORCE'SMOMENT 
(ABOUTDESIRED 
TOTALFLOOR 
REACTION FORCE 
CENTRAL- . 
POINT (DESIRED 
ZMP))Mdind 



/ 







/ Mlact 








DESIRED ZMP 


POSITION 





36 



INCLINATION 
SENSOR 



1121 



PO,STURE 
STABILIZATTON 
CONTROLLER 



6 em 



EP 1 361 027 A1 



FIG. 5 
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FIG. 6 
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FIG. 7 
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FIG. 9 
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FIG. 10 
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FIG. 1 1 
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FIG. 12 
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FIG. 15 
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ZMP CORRECTION AMOUNT 
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FIG. 18 
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DETERMINE DESIRED ZMP AT 
TIME t BASED ON CURRENT TIME 
GAIT PARAMETERS 
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DETERMINE DESIRED FEET 
POSITION/POSTURE AT TIME t BASED ON 
CURRENT TIME GATT PARAMETERS 
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DETERMINE DESIRED BODY POSTURE 
AT TIME t BASED ON CURRENT TIME 
GAIT PARAMETERS 
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CALCULATE LEG ZMP (ZMP feet) AT TIME t 
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CALCULATE INVERTED PENDULUM'S ZMP (ZMPpend) 
USING EQ.3 



lT 



S308 



CALCULATE INVERTED PENDULUM'S HORIZONTAL 
POSITION FROM INVERTED PENDULUM'S ZMP(ZMPpend) 
USING BQ.4 (DESCRIBING INVERTED PENDULUM) 
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DETERMINE HORIZONTAL BODY POSITION FROM 
INVERTED PENDULUM'S HORIZONTAL POSITION 
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DETERMINE VERTICAL BODY HEIGHT USING 
METHOD OF BODY HEIGHT DETERMINATION 
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FIG. 20 
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PROVISIONALLY DETERMME INITIAL BODY 
POSmONA/ELOCITY CANDIDATES (XO, VO) 



S400 



GENERATE GAIT BASED ON STEADY TURNING GAIT 
PARAMETERS USING DYNAMIC MODEL AND REGARDING (XO, VO^ 
AS BODY'S INITIAL STATE 



if 



S404 



CONVERT TERMINAL BODY POSITIOK/POSTURE OF GENERATED 
GAIT INTO VALUES VIEWED FROM NEXT STEP'S SUPPORTING LEG 
CXWRDINATE SYSTEM. AND DETERMINE THEM AS (Xe, Ve) 
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(enx,erry) == CXO,VO)-pCe,Ve) \_J~ 
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ARE errx, eny WITHIN 
PERMISSIBLE RANGE 
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DBlBRNflKE MULTIPLE XNITLM. VALUE CANDmATES 0(0+ ^ XO. VO) OCO VO -f- 
A VO) AROUND (XO, VO) AS INITIAL BODY STATE, GENERATE GAIT BASED ON 
STEADY. TURNING GAIT PARAJVIETERS, CONVERT TERMINAL BODY 
POSmON/POSTURE OF GENERATED GAIT INTO VALUES pCe+AXel VH-AVel) 
pCe+ A Xe2, Ve+ A Ve2) THAT ARE VALUES VIEWED FROM NEXT STEP'S 
SUPPORTING LEG COORDINATE SYSTEM 



DETERMNE NEXT INITIAL VALUE CANDIDATES (XO, VO) BASED ON 
PCO, VO), TERMINAL BODY POSITION/POSTURE AND (errs eny) 
RELATIVE TO INITIAL VALUE CANDIDATES THEREABOUT 
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DETERMINE INITIAL DIVERGENT COMPONENT q[0] OF STEADY 
TURNING GAIT USING FOLLOWING EQUATION 
q[0] = XO + VO/o;0 
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DETERMINE q" THAT IS A VALUE OBTAINED BY VIEWING STEADY 
TURNING GAIT'S IN1TL4L DIVERGENT COMPONENT qtO] FROM 
CURRENT TIME GAITS SUPPORTING LEG COORDINATE SYSTEM 
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FIG. 21 
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DETERMINE BODY POSITION/POSTURE QCe, Ve) AT CURRENT TIME 
GAIT TERMINAL BY CALCULATING CURRENT TIME GAIT UP TO 
TCRMmAL BASED ON PROVISIONAL DESIRED ZMP PATTERN AND 
OTHER CURRENT TIME'S dAlT IVU^^ 

DETERMINE TERMINAL DIVERGENT COMPONENT qO[k] USING 
FOLLOWING EQUATION 
qO[k]=Xe + Ve/cuO 
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DETERMINB TERMINAL DIVERGENT COMPONET ERROR 
errq USING FOLLOWING EQUATION 
errq = qO[k] • q" 



IT 
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IS errq WITHIN PERMISSIBLE 
RANGE? 
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EXIT LOOP 
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DETERMINE BODY POSITION/POSTURE (Xe, Ve) AT CURRJENT TIME 
GAIT TERMINAL BY CALCULATING CURRENT TIME GAIT UP TO 
TERMINAL BASED ON DESIRED 2MP (OBTAINED BY CORRECTING 
PROVISIONAL DESIRED ZMP PATTERN IN ACCORDANCE WITH 
RELATIONSHIP ILLUSTRATED IN FIG. 16) REGARDING a AS A a, AND 
DETERMINE TERMINAL DTVERGENT COMPONENT ql [k] USING. 
FOLLOWING EQUATION 
ql[k]« X^ + ye/ajQ ■ ■ - ■ ■ ■ ■ 
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DETERMINE PARAMETER SENSITIVITY r 
USING FOLLOWING EQUATION 
r = (ql[kJ-qO[k])/Aa 
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ADD CORRECTION AMOUNT a (=^eiTq/r) TO 
PROVISIONAL 2MP PATTERN TO CORRECT 
PROVISIONAL DESIRED ZMP 
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DETERMINE PROVISIONAL DESIRED ZMP 
PATTERN VALUES AS DESIRED ZMP 
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FIG. 22 



NEXT TIME'S 




SUPPORTIMG LEG TRANSITIONAL GAIT 

COORDINATE SYSTEM 



FIG. 23 
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